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@25:bd29d673e5d3, 2019-10-10 (annotated)

Committer:
paullj
Date:
Thu Oct 10 16:24:24 2019 +0000
Revision:
25:bd29d673e5d3
Parent:
24:899071abfc14
Child:
26:dd4f3ef421d1
Updated drive board 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 24:899071abfc14 7 #define LOG_INTERVAL 5000 // 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 21:4833e7fbcec7 27 {0x0051003D, 0x32375114, 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 25:bd29d673e5d3 32 {{{0.0908347476278717, 10.1921343711427}, {0.0497613470164513, 10.2109327517567}},
paullj 25:bd29d673e5d3 33 {{0.0596907336847412, 10.1550084867437}, {0.0320376283698263, 10.2580153464834}},
paullj 25:bd29d673e5d3 34 {{0.0119648730956925, 10.4065902688349}, {0.0256785142683800, 10.2921134395920}},
paullj 25:bd29d673e5d3 35 {{0.0482969653247984, 10.0688110602909}, {0.0882102280729402, 10.1322703041679}}};
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
paullj 21:4833e7fbcec7 99 if (i_board != -1) pc.printf("Drive board: Board %d\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 24:899071abfc14 107
sophiemeredith 12:3f1df385d781 108 for (int iStep=0; iStep<N_STEPS; iStep++) {
justinbuckland 16:2c563709cf09 109
justinbuckland 16:2c563709cf09 110 eTime = timer.read_ms();
paullj 25:bd29d673e5d3 111
justinbuckland 16:2c563709cf09 112 for (int iHeater=0; iHeater <2; iHeater++) {
justinbuckland 16:2c563709cf09 113 // measure heater
justinbuckland 16:2c563709cf09 114 if (iHeater==0)
justinbuckland 16:2c563709cf09 115 drive_1.pulsewidth_ticks(1000);
justinbuckland 16:2c563709cf09 116 else
justinbuckland 16:2c563709cf09 117 drive_2.pulsewidth_ticks(1000);
justinbuckland 16:2c563709cf09 118 wait_us(MEAS_DELAY);
justinbuckland 4:694f0e328a52 119
justinbuckland 16:2c563709cf09 120 //Start ADC conversion
justinbuckland 16:2c563709cf09 121 adc.start_conversion(15);
justinbuckland 16:2c563709cf09 122
justinbuckland 16:2c563709cf09 123 //Wait until ADC is free
justinbuckland 16:2c563709cf09 124 while(adc_busy == 1) {
justinbuckland 16:2c563709cf09 125 wait_us(1);
justinbuckland 16:2c563709cf09 126 }
justinbuckland 16:2c563709cf09 127
justinbuckland 16:2c563709cf09 128 //Turn off heater
justinbuckland 16:2c563709cf09 129 if (iHeater==0)
justinbuckland 16:2c563709cf09 130 drive_1.pulsewidth_ticks(0);
justinbuckland 16:2c563709cf09 131 else
justinbuckland 16:2c563709cf09 132 drive_2.pulsewidth_ticks(0);
justinbuckland 16:2c563709cf09 133 wait_us(MEAS_DELAY);
sophiemeredith 14:d764e256ac6d 134
justinbuckland 16:2c563709cf09 135 //Get ADC values
justinbuckland 16:2c563709cf09 136 adc.read_channels();
justinbuckland 16:2c563709cf09 137 curr[iHeater] = adc.read_channel_result(i_port[iHeater]);
justinbuckland 16:2c563709cf09 138 v[iHeater] = adc.read_channel_result(v_port[iHeater]);
justinbuckland 17:25831977b98e 139 r_adc[iHeater] = (float)v[iHeater]/(float)curr[iHeater];
paullj 21:4833e7fbcec7 140 if (i_board != -1)
justinbuckland 20:ab2d7aa17a20 141 r_ohm[iHeater] = drive_board_cal[i_board][iHeater][0] + r_adc[iHeater]*drive_board_cal[i_board][iHeater][1];
justinbuckland 17:25831977b98e 142 else
justinbuckland 17:25831977b98e 143 r_ohm[iHeater] = 0.0;
justinbuckland 17:25831977b98e 144
justinbuckland 24:899071abfc14 145 //Wait before drivinng other heater
justinbuckland 24:899071abfc14 146 wait_ms(LOG_INTERVAL/2);
justinbuckland 24:899071abfc14 147
justinbuckland 16:2c563709cf09 148 }
paullj 25:bd29d673e5d3 149 //Write output for iHeater
paullj 25:bd29d673e5d3 150 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 151
justinbuckland 16:2c563709cf09 152 }
justinbuckland 24:899071abfc14 153
justinbuckland 5:67e4ee9a00dc 154 }