Team Fox / Mbed 2 deprecated QM_BAE_review_1_EPS_updated

Updated EPS code with flowchart v2.3 (CDMS and HW faults)

Dependencies:   FreescaleIAP mbed-rtos mbed

Fork of QM_BAE_review_1_EPS_faults by Mohamed Azad

EPS.h@17:bb0d64656ba1, 2016-06-23 (annotated)

Committer:
azaddevarm
Date:
Thu Jun 23 12:14:28 2016 +0000
Revision:
17:bb0d64656ba1
Parent:
16:5f0f2a3f3e8d 
Updated EPS code with flowchart v2.3

Who changed what in which revision?

UserRevisionLine numberNew contents of line
sakthipriya 0:7b4c00e3912f 1 #include <mbed.h>
sakthipriya 0:7b4c00e3912f 2
sakthipriya 0:7b4c00e3912f 3 #define tstart -40
sakthipriya 0:7b4c00e3912f 4 #define tstep 8
sakthipriya 0:7b4c00e3912f 5 #define tstep_thermistor 8 //verify everything!!
sakthipriya 0:7b4c00e3912f 6 #define tstart_thermistor -40
sakthipriya 0:7b4c00e3912f 7 #define vstart 3.3
sakthipriya 0:7b4c00e3912f 8 #define vstep 0.84667
sakthipriya 0:7b4c00e3912f 9 #define cstart 0.0691
sakthipriya 0:7b4c00e3912f 10 #define cstep 0.09133
sakthipriya 2:c823d84b4cb0 11 #define vcell_start 5 //check
sakthipriya 2:c823d84b4cb0 12 #define vcell_step 0.0133 //check
sakthipriya 2:c823d84b4cb0 13 #define soc_start 0
sakthipriya 2:c823d84b4cb0 14 #define soc_step 0.3921
sakthipriya 2:c823d84b4cb0 15 #define crate_start 0 //check
sakthipriya 2:c823d84b4cb0 16 #define crate_step 1 //check
sakthipriya 2:c823d84b4cb0 17 #define AngularSpeed_start 0 //check
sakthipriya 2:c823d84b4cb0 18 #define AngularSpeed_step 0.1 //check
sakthipriya 0:7b4c00e3912f 19 #define rsens 0.095
sakthipriya 0:7b4c00e3912f 20
sakthipriya 2:c823d84b4cb0 21
sakthipriya 0:7b4c00e3912f 22 #define m_ADDR (0x6C) //slave address
sakthipriya 0:7b4c00e3912f 23
sakthipriya 0:7b4c00e3912f 24 //I2C register addresses
sakthipriya 0:7b4c00e3912f 25 #define REG_VCELL 0x02
sakthipriya 0:7b4c00e3912f 26 #define REG_SOC 0x04
sakthipriya 0:7b4c00e3912f 27 #define REG_MODE 0x06
sakthipriya 0:7b4c00e3912f 28 #define REG_VERSION 0x08
sakthipriya 0:7b4c00e3912f 29 #define REG_HIBRT 0x0A
sakthipriya 0:7b4c00e3912f 30 #define REG_CONFIG 0x0C
sakthipriya 0:7b4c00e3912f 31 #define REG_VALRT 0x14
sakthipriya 0:7b4c00e3912f 32 #define REG_CRATE 0x16
sakthipriya 0:7b4c00e3912f 33 #define REG_VRESET_ID 0x18
sakthipriya 0:7b4c00e3912f 34 #define REG_STATUS 0x1A
sakthipriya 0:7b4c00e3912f 35 #define REG_TABLE 0x40
sakthipriya 0:7b4c00e3912f 36 #define REG_CMD 0xFE
sakthipriya 0:7b4c00e3912f 37
sakthipriya 0:7b4c00e3912f 38 //.............Power switching..........
sakthipriya 0:7b4c00e3912f 39 #define TRXY_DR_EN PIN82 //torque rod driver enable
sakthipriya 0:7b4c00e3912f 40 #define TRZ_DR_EN PIN88
sakthipriya 0:7b4c00e3912f 41 #define ENBL3V3A PIN33
sakthipriya 3:07e15677a75c 42 //#define VBATT PIN20
sakthipriya 0:7b4c00e3912f 43 #define BATT_HEAT PIN96
sakthipriya 0:7b4c00e3912f 44 //#define BATT_HEAT_OUTPUT
sakthipriya 5:bb592f3185cc 45 extern void FCTN_CONVERT_FLOAT(float input, uint8_t* output);
sakthipriya 5:bb592f3185cc 46
sakthipriya 1:446a959e36ce 47 void FCTN_EPS_INIT();
azaddevarm 16:5f0f2a3f3e8d 48 void FCTN_EPS_HANDLE_CDMS_FAULT();
azaddevarm 16:5f0f2a3f3e8d 49 void FCTN_EPS_HANDLE_HW_FAULTS();
sakthipriya 0:7b4c00e3912f 50
sakthipriya 0:7b4c00e3912f 51 void FCTN_EPS_POWERMODE(float soc) ;
sakthipriya 0:7b4c00e3912f 52
sakthipriya 3:07e15677a75c 53 void FCTN_HK_MAIN();
sakthipriya 5:bb592f3185cc 54 void FCTN_APPEND_HKDATA();
sakthipriya 5:bb592f3185cc 55 uint8_t quantiz(float start,float step,float x);
sakthipriya 0:7b4c00e3912f 56
sakthipriya 2:c823d84b4cb0 57 void saveMin();
sakthipriya 2:c823d84b4cb0 58 void saveMax();
sakthipriya 2:c823d84b4cb0 59 void minMaxHkData();
sakthipriya 2:c823d84b4cb0 60
sakthipriya 0:7b4c00e3912f 61 void FCTN_BATTERYGAUGE_INIT();
sakthipriya 0:7b4c00e3912f 62 void FCTN_BATTERYGAUGE_MAIN(float*Battery_parameters);
sakthipriya 0:7b4c00e3912f 63
sakthipriya 1:446a959e36ce 64 // unsigned short read_soc(char , bool );
sakthipriya 1:446a959e36ce 65 unsigned short read_soc(char,bool ack);
sakthipriya 0:7b4c00e3912f 66 unsigned short read(char reg);
sakthipriya 0:7b4c00e3912f 67 void write(char reg, unsigned short data);
sakthipriya 0:7b4c00e3912f 68 void reset(); //not used
sakthipriya 0:7b4c00e3912f 69 void quickStart(); //not used
sakthipriya 0:7b4c00e3912f 70 void disable_sleep();
sakthipriya 0:7b4c00e3912f 71 void disable_hibernate();
sakthipriya 0:7b4c00e3912f 72 void socChangeAlertEnabled(bool);
sakthipriya 0:7b4c00e3912f 73 void compensation(char rcomp);
sakthipriya 0:7b4c00e3912f 74 void tempCompensation(float temp);
sakthipriya 0:7b4c00e3912f 75 void clearAlert();
sakthipriya 0:7b4c00e3912f 76 void emptyAlertThreshold(char threshold);
sakthipriya 0:7b4c00e3912f 77 void vAlertMinMaxThreshold();
sakthipriya 0:7b4c00e3912f 78 void vResetThresholSet();
sakthipriya 0:7b4c00e3912f 79 void vResetAlertEnabled(bool enabled);
sakthipriya 0:7b4c00e3912f 80 char alertFlags();
sakthipriya 0:7b4c00e3912f 81 void clearAlertFlags();
sakthipriya 0:7b4c00e3912f 82 float vcell();
sakthipriya 0:7b4c00e3912f 83 float soc();
sakthipriya 0:7b4c00e3912f 84 float crate();
sakthipriya 0:7b4c00e3912f 85 bool alerting();
sakthipriya 0:7b4c00e3912f 86 void vResetThresholdSet();
sakthipriya 0:7b4c00e3912f 87
sakthipriya 2:c823d84b4cb0 88 void FCTN_BATTTEMP_INIT();
sakthipriya 3:07e15677a75c 89 void FCTN_BATT_TEMP_SENSOR_MAIN(float*);
sakthipriya 2:c823d84b4cb0 90
sakthipriya 0:7b4c00e3912f 91 typedef struct BAE_HK_actual{
sakthipriya 0:7b4c00e3912f 92 float voltage_actual[16];
sakthipriya 0:7b4c00e3912f 93 float current_actual[12];
sakthipriya 0:7b4c00e3912f 94 float Batt_temp_actual[2];
sakthipriya 0:7b4c00e3912f 95 float Batt_gauge_actual[4];
sakthipriya 0:7b4c00e3912f 96 float BAE_temp_actual;
sakthipriya 4:39a4ae8c7ecd 97 char power_mode;
sakthipriya 5:bb592f3185cc 98 uint8_t faultPoll_status;
sakthipriya 5:bb592f3185cc 99 uint8_t faultIr_status;
sakthipriya 0:7b4c00e3912f 100 float AngularSpeed_actual[3];
sakthipriya 0:7b4c00e3912f 101 float Bvalue_actual[3];
sakthipriya 0:7b4c00e3912f 102 float Batt_voltage_actual;
sakthipriya 5:bb592f3185cc 103
sakthipriya 0:7b4c00e3912f 104 }BAE_HK_actual;
sakthipriya 0:7b4c00e3912f 105
sakthipriya 0:7b4c00e3912f 106 typedef struct BAE_HK_quant{
sakthipriya 5:bb592f3185cc 107 uint8_t voltage_quant[16]; //power_mode + faults should be appended to sd card
sakthipriya 5:bb592f3185cc 108 uint8_t current_quant[12];
sakthipriya 5:bb592f3185cc 109 uint8_t Batt_temp_quant[2];
sakthipriya 5:bb592f3185cc 110 uint8_t Batt_gauge_quant[3]; // why only 3 here??
sakthipriya 9:194afacf7449 111 float Batt_gauge_alerts; //why is this float??
sakthipriya 5:bb592f3185cc 112 uint8_t BAE_temp_quant;
sakthipriya 5:bb592f3185cc 113 float AngularSpeed_quant[3];
sakthipriya 0:7b4c00e3912f 114 float Bvalue_quant[3];
sakthipriya 5:bb592f3185cc 115 uint8_t Batt_voltage_quant;
sakthipriya 0:7b4c00e3912f 116 }BAE_HK_quant;
sakthipriya 0:7b4c00e3912f 117
sakthipriya 5:bb592f3185cc 118 typedef struct BAE_HK_arch{ //power_mode + faults should be appended to sd card
sakthipriya 0:7b4c00e3912f 119
sakthipriya 5:bb592f3185cc 120 uint8_t Batt_1_temp; //verify if uint8_t is right
sakthipriya 5:bb592f3185cc 121 uint8_t Batt_2_temp;
sakthipriya 5:bb592f3185cc 122 uint8_t EPS_PCB_temp;
sakthipriya 5:bb592f3185cc 123 uint8_t Batt_SOC;
sakthipriya 0:7b4c00e3912f 124 char power_mode;
sakthipriya 5:bb592f3185cc 125 uint8_t faultPoll_status;
sakthipriya 5:bb592f3185cc 126 uint8_t faultIr_status;
sakthipriya 5:bb592f3185cc 127 uint8_t Batt_voltage;
sakthipriya 5:bb592f3185cc 128
sakthipriya 0:7b4c00e3912f 129 //char Batt_voltage2;
sakthipriya 0:7b4c00e3912f 130 // char Digital power bus voltage;
sakthipriya 0:7b4c00e3912f 131
sakthipriya 0:7b4c00e3912f 132
sakthipriya 0:7b4c00e3912f 133 }BAE_HK_arch;
sakthipriya 0:7b4c00e3912f 134
sakthipriya 0:7b4c00e3912f 135 typedef struct BAE_HK_min_max{
sakthipriya 5:bb592f3185cc 136 uint8_t voltage_max[16];
sakthipriya 5:bb592f3185cc 137 uint8_t current_max[12];
sakthipriya 5:bb592f3185cc 138 uint8_t Batt_temp_max[2];
sakthipriya 5:bb592f3185cc 139 uint8_t Batt_gauge_max[3];
sakthipriya 5:bb592f3185cc 140 uint8_t BAE_temp_max;
sakthipriya 5:bb592f3185cc 141 float AngularSpeed_max[3];
sakthipriya 0:7b4c00e3912f 142 float Bvalue_max[3];
sakthipriya 5:bb592f3185cc 143 uint8_t Batt_voltage_max;
sakthipriya 0:7b4c00e3912f 144
sakthipriya 5:bb592f3185cc 145 uint8_t voltage_min[16];
sakthipriya 5:bb592f3185cc 146 uint8_t current_min[12];
sakthipriya 5:bb592f3185cc 147 uint8_t Batt_temp_min[2];
sakthipriya 5:bb592f3185cc 148 uint8_t Batt_gauge_min[3];
sakthipriya 5:bb592f3185cc 149 uint8_t BAE_temp_min;
sakthipriya 5:bb592f3185cc 150 float AngularSpeed_min[3];
sakthipriya 0:7b4c00e3912f 151 float Bvalue_min[3];
sakthipriya 5:bb592f3185cc 152 uint8_t Batt_voltage_min;
sakthipriya 0:7b4c00e3912f 153
sakthipriya 0:7b4c00e3912f 154 }BAE_HK_min_max;
sakthipriya 0:7b4c00e3912f 155