Team Fox / Mbed 2 deprecated RAJANGAM_REVIEW_BAE_CODE

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   FreescaleIAP mbed-rtos mbed

Fork of QM_BAE_review_1 by Team Fox

EPS.h@31:046685b48b71, 2016-07-01 (annotated)

Committer:
azaddevarm
Date:
Fri Jul 01 15:22:18 2016 +0000
Revision:
31:046685b48b71
Parent:
30:22b338b027de 
Updates EPS states;

Who changed what in which revision?

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