67 lines
1.8 KiB
C++
67 lines
1.8 KiB
C++
/*
|
|
* power.cpp
|
|
*
|
|
* Created on: 28 Oct, 2018
|
|
* Authors: Ben V. Brown, David Hilton
|
|
*/
|
|
|
|
#include <power.hpp>
|
|
#include <Settings.h>
|
|
#include <hardware.h>
|
|
|
|
uint8_t tipResistance = 85; //x10 ohms, 8.5 typical for ts100, 4.5 typical for ts80
|
|
const uint16_t powerPWM = 255;
|
|
const uint16_t totalPWM = 255 + 60; //htim2.Init.Period, the full PWM cycle
|
|
|
|
history<uint32_t, oscillationPeriod> milliWattHistory = { { 0 }, 0, 0 };
|
|
|
|
void setupPower(uint8_t res) {
|
|
tipResistance = res;
|
|
}
|
|
|
|
int32_t tempToMilliWatts(int32_t rawTemp, uint16_t mass, uint8_t rawC) {
|
|
// mass is in milliJ/*C, rawC is raw per degree C
|
|
// returns milliWatts needed to raise/lower a mass by rawTemp
|
|
// degrees in one cycle.
|
|
int32_t milliJoules = mass * rawTemp / rawC;
|
|
return milliJoules * hz;
|
|
}
|
|
|
|
void setTipMilliWatts(int32_t mw) {
|
|
//Enforce Max Watts Limiter # TODO
|
|
|
|
int32_t output = milliWattsToPWM(mw, systemSettings.voltageDiv / 10,1);
|
|
setTipPWM(output);
|
|
uint16_t actualMilliWatts = PWMToMilliWatts(output,
|
|
systemSettings.voltageDiv / 10);
|
|
|
|
milliWattHistory.update(actualMilliWatts);
|
|
}
|
|
|
|
uint8_t milliWattsToPWM(int32_t milliWatts, uint8_t divisor, uint8_t sample) {
|
|
//P = V^2 / R, v*v = v^2 * 100
|
|
// R = R*10
|
|
// P therefore is in V^2*10/R = W*10.
|
|
// Scale input milliWatts to the pwm rate
|
|
if (milliWatts == 0)
|
|
return 0;
|
|
int32_t v = getInputVoltageX10(divisor, sample); // 100 = 10v
|
|
int32_t availableMilliWatts = v * v / tipResistance;
|
|
|
|
//int32_t pwm = ((powerPWM * totalPWM / powerPWM) * milliWatts) / availableMilliWatts;
|
|
int32_t pwm = (totalPWM * milliWatts) / availableMilliWatts;
|
|
if (pwm > powerPWM) {
|
|
pwm = powerPWM;
|
|
} else if (pwm < 0) {
|
|
pwm = 0;
|
|
}
|
|
|
|
|
|
return pwm;
|
|
}
|
|
|
|
int32_t PWMToMilliWatts(uint8_t pwm, uint8_t divisor) {
|
|
int32_t v = getInputVoltageX10(divisor, 0);
|
|
return pwm * (v * v / tipResistance) / (powerPWM * totalPWM / powerPWM);
|
|
}
|