afterburner/aftb_vpp.h

318 lines
7.6 KiB
C
Raw Normal View History

/*
* Variable voltage functions for Afterburner GAL project.
*
*/
#include <EEPROM.h>
// ensure mcp4131 pot uses the right pins
#define POT_CS A3
#define POT_CLK A4
#define POT_DAT A5
#define VPP A0
#include "aftb_mcp4131.h"
#ifndef FAIL
#define FAIL 0
#define OK 1
#endif
#define ABS(X) ((X) < 0 ? -(X) : (X));
#define VPP_5V0 0xFF
#define VPP_9V0 0
#define VPP_9V5 1
#define VPP_10V0 2
#define VPP_10V5 3
#define VPP_11V0 4
#define VPP_11V5 5
#define VPP_12V0 6
#define VPP_12V5 7
#define VPP_13V0 8
#define VPP_13V5 9
#define VPP_14V0 10
#define VPP_14V5 11
#define VPP_15V0 12
#define VPP_15V5 13
#define VPP_16V0 14
#define VPP_16V5 15
#define MAX_WIPER 16
#define VPP_VERBOSE 0
//pot wiper indices for the voltages
uint8_t vppWiper[MAX_WIPER] = {0};
// VPP must ramp-up to prevent voltage spikes and possibly resting arduino
#define varVppSetMax() varVppSetVppIndex(0x40); \
varVppSetVppIndex(0x70); \
varVppSetVppIndex(0x7c); \
varVppSetVppIndex(0x7e); \
varVppSetVppIndex(0x80);
#define varVppSetMin() varVppSetVppIndex(0x0);
uint8_t wiperStat = 0; //enabled / disabled
int8_t calOffset = 0; // VPP calibration offset: value 10 is 0.1V, value -10 is -0.1V
static void varVppReadCalib(void) {
uint8_t i;
//calibration not found
if (EEPROM.read(0) != 0xAF || EEPROM.read(1) != 0xCA) {
vppWiper[0] = 0;
Serial.println(F("No calibration data in EEPROM"));
return;
}
calOffset = (int8_t) EEPROM.read(2);
for (i = 0; i < MAX_WIPER; i++) {
vppWiper[i] = EEPROM.read(i + 3);
#if 0
Serial.print(F("Calib "));
Serial.print(i);
Serial.print(F(":"));
Serial.println(vppWiper[i]);
#endif
}
}
// internal use only - set the wiper value on the digital pot
static void varVppSetVppIndex(uint8_t value) {
uint8_t i;
#if VPP_VERBOSE
Serial.print(F("varSetVppIndex "));
Serial.println(value);
#endif
mcp4131_write(ADDR_WIPER, value);
#if VPP_PARANOID
i = mcp4131_read(ADDR_WIPER);
if (i != value) {
Serial.print(F("Error writing POT value. Expected:"));
Serial.print(value);
Serial.print(F(" Actual:"));
Serial.println(i);
}
#endif
if (value == 0) {
mcp4131_disableWiper();
wiperStat = 0;
} else if (wiperStat == 0) {
mcp4131_enableWiper();
wiperStat = 1;
}
}
//use by the app code - set the variable voltage
static void varVppSet(uint8_t value) {
uint8_t v;
int8_t inc;
int8_t incMin;
if (value == VPP_5V0 || value >= MAX_WIPER) {
varVppSetVppIndex(0);
return;
}
#if VPP_VERBOSE
Serial.print(F("varSetVpp "));
Serial.print(value);
Serial.print(F(":"));
Serial.println(vppWiper[value]);
#endif
//ramp up to prevent massive voltage overshoots
v = vppWiper[value] / 2;
v -= 2;
inc = 16;
incMin = 2;
if (value > VPP_13V0) {
incMin = 1;
}
while (v < vppWiper[value]) {
varVppSetVppIndex(v);
v+= inc + (inc / 2);
inc -= inc / 2;
if (inc < incMin) {
inc = incMin;
}
}
varVppSetVppIndex(vppWiper[value]);
}
#define SAMPLE_CNT 14
static int16_t varVppMeasureVpp(int8_t printValue) {
int8_t i = 0;
uint16_t r1 = 0;
while (i++ < SAMPLE_CNT) {
r1 += analogRead(VPP);
}
r1+= 5;
r1 /= 8;
r1 += calOffset;
if (printValue) {
uint8_t a = r1%100;
Serial.print(r1/100);
Serial.print(F("."));
if (a < 10) {
Serial.print(F("0"));
}
Serial.println(a);
}
return r1;
}
// Returns 1 on Success, 0 on Failure
static uint8_t varVppCalibrateVpp(void) {
uint8_t vppIndex = 0;
uint8_t i = 1;
int16_t v = 900; //starting at 9.00 V
int16_t r1 = 0;
int16_t r2;
int16_t minDif = 5000;
Serial.print(F("VPP calib. offset: "));
Serial.println(calOffset);
varVppSetVppIndex(1);
delay(300); //settle voltage
while (1) {
while (i <= 0x80) {
int16_t d1,d2;
varVppSetVppIndex(i);
delay(50); //let the voltage settle
#if VPP_VERBOSE
Serial.print(i);
Serial.print(F(") "));
#endif
r2 = varVppMeasureVpp(0);
d1 = r1 - v;
d2 = r2 - v;
d1 = ABS(d1);
d2 = ABS(d2);
if (r2 <= 100) { // less than 1V ? Failure
r1 = FAIL;
goto ret;
}
if (d2 < minDif) {
minDif = d2;
vppWiper[vppIndex] = i;
//check last value / voltage
if (i == 0x80) {
if (v >= 1620 && v <= 1670) {
#if 1 || VPP_VERBOSE
Serial.println(F("*Index for VPP 1650 is 128"));
#endif
r1 = OK;
goto ret;
}
r1 = FAIL;
goto ret;
}
} else {
i--;
minDif = 5000;
#if 1 || VPP_VERBOSE
Serial.print(F("*Index for VPP "));
Serial.print(v);
Serial.print(F(" is "));
Serial.println(i);
#endif
break;
}
r1 = r2;
i++;
}
vppIndex++;
#if VPP_VERBOSE
Serial.print(F("vppIndex "));
Serial.println(vppIndex);
#endif
if (vppIndex >= MAX_WIPER) {
r1 = OK;
goto ret;
}
v += 50;
}
ret:
varVppSet(VPP_5V0);
return r1;
}
static void varVppStoreWiperCalib() {
uint8_t i = 0;
//sanity check
if (vppWiper[0] == 0) {
return;
}
//write Afterburner calibration header
EEPROM.update(0, 0xAF);
EEPROM.update(1, 0xCA);
EEPROM.update(2, (uint8_t) calOffset);
while (i < MAX_WIPER) {
EEPROM.update(3 + i, vppWiper[i]);
i++;
}
}
//return 1 on success (variable VPP functionality present), 0 on failure (VPP not detected on board)
static int8_t varVppInit(void) {
analogReference(EXTERNAL); //use 3V3 external reference
wiperStat = 0; //wiper disabled
mcp4131_init();
if (mcp4131_detect()) {
#if VPP_VERBOSE
Serial.println(F("POT found"));
#endif
return OK;
} else {
#if VPP_VERBOSE
Serial.println(F("POT not found"));
#endif
return FAIL;
}
}
//return 1 on success (VPP calibration appears correct), 0 on failure
static int8_t varVppCheckCalibration(void) {
int16_t v;
varVppReadCalib();
if (vppWiper[0] == 0) {
Serial.println(F("I: VPP not calibrated"));
return FAIL;
}
#if 0
// This shoots the VPP to 9V - in theory no GALs should have an issue with that voltage.
// Also, the On switch should be turned off, preventing VPP to reach the GAL pins.
// check actual voltage
varVppSet(VPP_9V0);
delay(200); //Settle voltage
v = varVppMeasureVpp(0);
varVppSet(VPP_5V0); //set VPP back to 5V
// lower voltages have a good resolution, so we can have a tight voltage check bounds
if (v < 890 || v > 910) {
Serial.print(F("ER: VPP voltage check of 9V failed. Expected 900, measured "));
Serial.println(v);
return FAIL;
}
#endif
return OK;
}
static int8_t varVppCalibrate(void) {
if (varVppCalibrateVpp()) {
varVppStoreWiperCalib();
} else {
Serial.println(F("ER: Wiper calibration failed"));
return FAIL;
}
return OK;
}