The Technology Partnership / Mbed 2 deprecated MEMSPCR_Control_Program_AD_Logging_PWM_Calibration

Used for calibration consumables

Dependencies:   mbed MODSERIAL FastPWM ADS8568_ADC

main.cpp@29:f2585571ce25, 2020-03-17 (annotated)

Committer:
paullj
Date:
Tue Mar 17 14:57:49 2020 +0000
Revision:
29:f2585571ce25
Parent:
27:5dcd526d7598
Child:
30:ab214b681d9b
Updated calibration

Who changed what in which revision?

UserRevisionLine numberNew contents of line
AlexStokoe 0:362148ad8f6f 1 #include "mbed.h"
justinbuckland 16:2c563709cf09 2 #include "ADS8568_ADC.h"
justinbuckland 16:2c563709cf09 3 #include "FastPWM.h"
justinbuckland 16:2c563709cf09 4 #include "MODSERIAL.h"
AlexStokoe 0:362148ad8f6f 5
paullj 25:bd29d673e5d3 6 #define MEAS_DELAY 60 // measurement delay after turning on FET (us)
justinbuckland 26:dd4f3ef421d1 7 #define LOG_INTERVAL 1000 // log file interval (ms)
justinbuckland 16:2c563709cf09 8 #define START_DELAY 1000 // pause for startup (ms)
justinbuckland 22:aba3ee6df08e 9 #define N_STEPS 100
justinbuckland 16:2c563709cf09 10 #define BUFFER_SIZE 4096
AlexStokoe 0:362148ad8f6f 11
justinbuckland 17:25831977b98e 12 //UID lookup address and pointer
justinbuckland 17:25831977b98e 13 #define UID_ADDR 0x1FFF7A10
justinbuckland 17:25831977b98e 14 unsigned long *uid = (unsigned long *) UID_ADDR;
justinbuckland 17:25831977b98e 15
justinbuckland 17:25831977b98e 16 //UID and drive board calibration table
justinbuckland 17:25831977b98e 17 #define UID_TABLE_LENGTH 4
justinbuckland 17:25831977b98e 18
justinbuckland 17:25831977b98e 19 int drive_board_serial_number[UID_TABLE_LENGTH] =
justinbuckland 17:25831977b98e 20 {1,
justinbuckland 17:25831977b98e 21 2,
justinbuckland 17:25831977b98e 22 3,
justinbuckland 17:25831977b98e 23 4};
justinbuckland 17:25831977b98e 24
justinbuckland 17:25831977b98e 25 unsigned long drive_board_uid[UID_TABLE_LENGTH][3] =
justinbuckland 17:25831977b98e 26 {{0x005B0060, 0x32375101, 0x32363531},
paullj 29:f2585571ce25 27 {0x00530028, 0x32375116, 0x30333732},
paullj 21:4833e7fbcec7 28 {0x00520060, 0x32375101, 0x32363531},
paullj 21:4833e7fbcec7 29 {0x00570060, 0x32375101, 0x32363531}};
justinbuckland 17:25831977b98e 30
justinbuckland 20:ab2d7aa17a20 31 float drive_board_cal[UID_TABLE_LENGTH][2][2] =
paullj 29:f2585571ce25 32 {{{0.098846, 10.190057}, {0.060713, 10.208784}},
paullj 29:f2585571ce25 33 {{0.060987, 10.154840}, {0.033058, 10.239591}},
paullj 29:f2585571ce25 34 {{0.014312, 10.405662}, {0.000000, 1.0000000}},
paullj 29:f2585571ce25 35 {{0.055152, 10.062970}, {0.114355, 10.123188}}};
justinbuckland 17:25831977b98e 36
justinbuckland 16:2c563709cf09 37 MODSERIAL pc(PA_9, PA_10, BUFFER_SIZE); //mcu TX, RX, BUFFER_SIZE byte TX and RX buffers
justinbuckland 16:2c563709cf09 38 ADS8568_ADC adc(PB_15, PB_14, PB_13, PB_12, PC_15, PC_0, PC_1, PC_2, PC_3);
justinbuckland 16:2c563709cf09 39 I2C i2c(PB_7, PB_8); //SDA, SCL
sophiemeredith 11:8e6c8e654004 40 Timer timer;
justinbuckland 16:2c563709cf09 41 DigitalIn adc_busy(PA_8); //Busy interrupt sig#
sophiemeredith 11:8e6c8e654004 42
justinbuckland 16:2c563709cf09 43 //Heater Control
justinbuckland 16:2c563709cf09 44 FastPWM drive_1(PC_9);
justinbuckland 16:2c563709cf09 45 FastPWM drive_2(PC_8);
justinbuckland 16:2c563709cf09 46 FastPWM guard_1(PC_7);
justinbuckland 16:2c563709cf09 47 FastPWM guard_2(PC_6);
AlexStokoe 0:362148ad8f6f 48
justinbuckland 16:2c563709cf09 49 //Indicator LEDs
justinbuckland 16:2c563709cf09 50 DigitalOut hb_led(PC_13); //Green
justinbuckland 16:2c563709cf09 51 DigitalOut led_0(PC_4); //Red
justinbuckland 16:2c563709cf09 52 DigitalOut led_1(PC_5); //Green
justinbuckland 16:2c563709cf09 53
justinbuckland 16:2c563709cf09 54 //User buttons
justinbuckland 16:2c563709cf09 55 DigitalIn user_0(PB_0);
justinbuckland 16:2c563709cf09 56 DigitalIn user_1(PB_1);
justinbuckland 16:2c563709cf09 57
justinbuckland 16:2c563709cf09 58 BusOut converts(PC_0, PC_1, PC_2, PC_3);
AlexStokoe 0:362148ad8f6f 59
AlexStokoe 0:362148ad8f6f 60 int main() {
sophiemeredith 11:8e6c8e654004 61 int eTime;
justinbuckland 16:2c563709cf09 62 int v[2], curr[2];
justinbuckland 17:25831977b98e 63 double r_adc[2], r_ohm[2];
justinbuckland 16:2c563709cf09 64
justinbuckland 16:2c563709cf09 65 int i_port[2] = {0,2};
justinbuckland 16:2c563709cf09 66 int v_port[2] = {1,3};
justinbuckland 2:23f848b21b09 67
justinbuckland 16:2c563709cf09 68 pc.baud(115200);
justinbuckland 16:2c563709cf09 69 adc.init();
AlexStokoe 0:362148ad8f6f 70
justinbuckland 16:2c563709cf09 71 // Initialsation - all heaters off
justinbuckland 16:2c563709cf09 72 drive_1.prescaler(1);
justinbuckland 16:2c563709cf09 73 drive_1.period_ticks(1000);
justinbuckland 16:2c563709cf09 74 drive_1.pulsewidth_ticks(0);
justinbuckland 16:2c563709cf09 75
justinbuckland 16:2c563709cf09 76 guard_1.prescaler(1);
justinbuckland 16:2c563709cf09 77 guard_1.period_ticks(1000);
justinbuckland 16:2c563709cf09 78 guard_1.pulsewidth_ticks(0);
justinbuckland 16:2c563709cf09 79
justinbuckland 16:2c563709cf09 80 drive_2.prescaler(1);
justinbuckland 16:2c563709cf09 81 drive_2.period_ticks(1000);
justinbuckland 16:2c563709cf09 82 drive_2.pulsewidth_ticks(0);
justinbuckland 16:2c563709cf09 83
justinbuckland 16:2c563709cf09 84 guard_2.prescaler(1);
justinbuckland 16:2c563709cf09 85 guard_2.period_ticks(1000);
justinbuckland 16:2c563709cf09 86 guard_2.pulsewidth_ticks(0);
justinbuckland 16:2c563709cf09 87
justinbuckland 17:25831977b98e 88 pc.printf("\r\nUnique ID: %08X %08X %08X \r\n", uid[0], uid[1], uid[2]);
paullj 21:4833e7fbcec7 89 int i_board = -1;
justinbuckland 17:25831977b98e 90 for (int i = 0; i < UID_TABLE_LENGTH; i++)
justinbuckland 17:25831977b98e 91 {
justinbuckland 17:25831977b98e 92 if (uid[0]==drive_board_uid[i][0] && uid[1]==drive_board_uid[i][1] && uid[2]==drive_board_uid[i][2])
justinbuckland 17:25831977b98e 93 {
justinbuckland 20:ab2d7aa17a20 94 i_board = i;
justinbuckland 17:25831977b98e 95 i = UID_TABLE_LENGTH;
justinbuckland 17:25831977b98e 96 }
justinbuckland 17:25831977b98e 97 }
justinbuckland 17:25831977b98e 98
justinbuckland 26:dd4f3ef421d1 99 if (i_board != -1) pc.printf("Drive board: Board %d ADC measurement: PWM heater pulse, 60us delay\n",drive_board_serial_number[i_board]);
justinbuckland 17:25831977b98e 100 else pc.printf("Drive board UID match not found\n");
justinbuckland 17:25831977b98e 101
justinbuckland 17:25831977b98e 102 pc.printf("iStep, eTime, I1, V1, R1_adc, R1_ohm, I2, V2, R2_adc, R2_ohm\n");
AlexStokoe 0:362148ad8f6f 103
justinbuckland 16:2c563709cf09 104 wait_ms(START_DELAY);
justinbuckland 16:2c563709cf09 105 timer.start();
AlexStokoe 0:362148ad8f6f 106
justinbuckland 27:5dcd526d7598 107 // indicate start
justinbuckland 27:5dcd526d7598 108 led_0 = 0;
justinbuckland 27:5dcd526d7598 109 led_1 = 1;
justinbuckland 27:5dcd526d7598 110
sophiemeredith 12:3f1df385d781 111 for (int iStep=0; iStep<N_STEPS; iStep++) {
justinbuckland 16:2c563709cf09 112
justinbuckland 16:2c563709cf09 113 eTime = timer.read_ms();
paullj 25:bd29d673e5d3 114
justinbuckland 16:2c563709cf09 115 for (int iHeater=0; iHeater <2; iHeater++) {
justinbuckland 16:2c563709cf09 116 // measure heater
justinbuckland 27:5dcd526d7598 117 if (iHeater==0)
justinbuckland 16:2c563709cf09 118 drive_1.pulsewidth_ticks(1000);
justinbuckland 16:2c563709cf09 119 else
justinbuckland 16:2c563709cf09 120 drive_2.pulsewidth_ticks(1000);
justinbuckland 16:2c563709cf09 121 wait_us(MEAS_DELAY);
justinbuckland 4:694f0e328a52 122
justinbuckland 16:2c563709cf09 123 //Start ADC conversion
justinbuckland 16:2c563709cf09 124 adc.start_conversion(15);
justinbuckland 16:2c563709cf09 125
justinbuckland 16:2c563709cf09 126 //Wait until ADC is free
justinbuckland 16:2c563709cf09 127 while(adc_busy == 1) {
justinbuckland 16:2c563709cf09 128 wait_us(1);
justinbuckland 16:2c563709cf09 129 }
justinbuckland 16:2c563709cf09 130
justinbuckland 16:2c563709cf09 131 //Turn off heater
justinbuckland 16:2c563709cf09 132 if (iHeater==0)
justinbuckland 16:2c563709cf09 133 drive_1.pulsewidth_ticks(0);
justinbuckland 16:2c563709cf09 134 else
justinbuckland 16:2c563709cf09 135 drive_2.pulsewidth_ticks(0);
justinbuckland 27:5dcd526d7598 136
justinbuckland 16:2c563709cf09 137 wait_us(MEAS_DELAY);
sophiemeredith 14:d764e256ac6d 138
justinbuckland 16:2c563709cf09 139 //Get ADC values
justinbuckland 16:2c563709cf09 140 adc.read_channels();
justinbuckland 16:2c563709cf09 141 curr[iHeater] = adc.read_channel_result(i_port[iHeater]);
justinbuckland 16:2c563709cf09 142 v[iHeater] = adc.read_channel_result(v_port[iHeater]);
justinbuckland 17:25831977b98e 143 r_adc[iHeater] = (float)v[iHeater]/(float)curr[iHeater];
paullj 21:4833e7fbcec7 144 if (i_board != -1)
justinbuckland 20:ab2d7aa17a20 145 r_ohm[iHeater] = drive_board_cal[i_board][iHeater][0] + r_adc[iHeater]*drive_board_cal[i_board][iHeater][1];
justinbuckland 17:25831977b98e 146 else
justinbuckland 17:25831977b98e 147 r_ohm[iHeater] = 0.0;
justinbuckland 17:25831977b98e 148
justinbuckland 24:899071abfc14 149 //Wait before drivinng other heater
justinbuckland 24:899071abfc14 150 wait_ms(LOG_INTERVAL/2);
justinbuckland 24:899071abfc14 151
justinbuckland 16:2c563709cf09 152 }
paullj 25:bd29d673e5d3 153 //Write output for iHeater
paullj 25:bd29d673e5d3 154 pc.printf("%5d, %10d, %10d, %10d, %10.6f, %10.6f, %10d, %10d, %10.6f, %10.6f \n", iStep, eTime, curr[0], v[0], r_adc[0], r_ohm[0], curr[1], v[1], r_adc[1], r_ohm[1]);
justinbuckland 24:899071abfc14 155
justinbuckland 16:2c563709cf09 156 }
justinbuckland 27:5dcd526d7598 157
justinbuckland 27:5dcd526d7598 158 // indicate stop
justinbuckland 27:5dcd526d7598 159 led_0 = 1;
justinbuckland 27:5dcd526d7598 160 led_1 = 0;
justinbuckland 24:899071abfc14 161
justinbuckland 5:67e4ee9a00dc 162 }