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 workinQM_5thJan_azad by
EPS.h@28:5f0f2a3f3e8d, 2016-06-13 (annotated)
- Committer:
- azaddevarm
- Date:
- Mon Jun 13 10:37:50 2016 +0000
- Revision:
- 28:5f0f2a3f3e8d
- Parent:
- 9:194afacf7449
- Child:
- 30:22b338b027de
Added EPS faults
Who changed what in which revision?
| User | Revision | Line number | New 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 | 28:5f0f2a3f3e8d | 48 | void FCTN_EPS_HANDLE_CDMS_FAULT(); | 
| azaddevarm | 28: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 | 
