KIT Solar Car Project / Mbed OS BMS_3029

BMS_T1

Dependencies:   INA226

main.cpp@3:61174d4de67d, 2020-10-13 (annotated)

Committer:
takuma1
Date:
Tue Oct 13 07:20:11 2020 +0000
Revision:
3:61174d4de67d
Parent:
2:3bbbe439ec11 
BMS_T2;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
APS_Lab 0:f06ed53310a3 1
APS_Lab 0:f06ed53310a3 2 #include "mbed.h"
APS_Lab 0:f06ed53310a3 3 #include "bms.h"
APS_Lab 0:f06ed53310a3 4 #include "LTC681x.h"
APS_Lab 0:f06ed53310a3 5 #include "LTC6811.h"
takuma1 2:3bbbe439ec11 6 #include "CAN.h"
takuma1 2:3bbbe439ec11 7 #include "INA226.hpp"
takuma1 3:61174d4de67d 8
takuma1 2:3bbbe439ec11 9
APS_Lab 0:f06ed53310a3 10
APS_Lab 0:f06ed53310a3 11 #define UI_BUFFER_SIZE 64
APS_Lab 0:f06ed53310a3 12 #define SERIAL_TERMINATOR '\n'
APS_Lab 0:f06ed53310a3 13
APS_Lab 0:f06ed53310a3 14 #define ENABLED 1
APS_Lab 0:f06ed53310a3 15 #define DISABLED 0
APS_Lab 0:f06ed53310a3 16
APS_Lab 0:f06ed53310a3 17 #define DATALOG_ENABLED 1
APS_Lab 0:f06ed53310a3 18 #define DATALOG_DISABLED 0
takuma1 2:3bbbe439ec11 19
takuma1 2:3bbbe439ec11 20
takuma1 2:3bbbe439ec11 21
APS_Lab 0:f06ed53310a3 22 DigitalOut led1(LED1);
APS_Lab 0:f06ed53310a3 23 Serial pc(USBTX, USBRX);
takuma1 2:3bbbe439ec11 24 CAN can1(p9,p10);
takuma1 2:3bbbe439ec11 25 CAN can2(p30,p29);
takuma1 2:3bbbe439ec11 26 I2C i2c(p28,p27);
takuma1 2:3bbbe439ec11 27 DigitalOut BAT_MIN_safty(p21);
takuma1 2:3bbbe439ec11 28 DigitalOut BAT_MAX_safty(p22);
takuma1 2:3bbbe439ec11 29 INA226 VCmonitor(i2c);
takuma1 3:61174d4de67d 30
takuma1 2:3bbbe439ec11 31
APS_Lab 0:f06ed53310a3 32
APS_Lab 0:f06ed53310a3 33 void run_command(uint32_t cmd);
APS_Lab 0:f06ed53310a3 34 void measurement_loop(uint8_t datalog_en);
takuma1 2:3bbbe439ec11 35 //void print_menu();
APS_Lab 0:f06ed53310a3 36 void print_cells(uint8_t datalog_en);
APS_Lab 0:f06ed53310a3 37 void print_open();
APS_Lab 0:f06ed53310a3 38 void print_aux(uint8_t datalog_en);
APS_Lab 0:f06ed53310a3 39 void print_stat();
APS_Lab 0:f06ed53310a3 40 void print_config();
APS_Lab 0:f06ed53310a3 41 void print_rxconfig();
APS_Lab 0:f06ed53310a3 42 void print_pec(void);
APS_Lab 0:f06ed53310a3 43 void serial_print_hex(uint8_t data);
APS_Lab 0:f06ed53310a3 44 void check_error(int error);
takuma1 2:3bbbe439ec11 45 void wakeup();
takuma1 2:3bbbe439ec11 46 void cell_read();
takuma1 2:3bbbe439ec11 47 void spi_error();
takuma1 2:3bbbe439ec11 48 void ic_check();
takuma1 2:3bbbe439ec11 49 void spi_check();
takuma1 2:3bbbe439ec11 50 void print_CAN(uint8_t datalog_en);
takuma1 2:3bbbe439ec11 51 void print_math();
takuma1 2:3bbbe439ec11 52 void can_sent1();
takuma1 2:3bbbe439ec11 53 void can_sent2();
takuma1 2:3bbbe439ec11 54 void can_sent3();
takuma1 2:3bbbe439ec11 55 void can_sent4();
takuma1 2:3bbbe439ec11 56 //void can_set();
takuma1 2:3bbbe439ec11 57 void can_wait();
takuma1 2:3bbbe439ec11 58 void ic_set();
takuma1 2:3bbbe439ec11 59
takuma1 2:3bbbe439ec11 60
APS_Lab 0:f06ed53310a3 61 //char get_char();
APS_Lab 0:f06ed53310a3 62 //void read_config_data(uint8_t cfg_data[][6], uint8_t nIC);
APS_Lab 0:f06ed53310a3 63
takuma1 2:3bbbe439ec11 64 const uint8_t TOTAL_IC = 3;//!<number of ICs in the daisy chain
APS_Lab 0:f06ed53310a3 65 char ui_buffer[UI_BUFFER_SIZE];
APS_Lab 0:f06ed53310a3 66
APS_Lab 0:f06ed53310a3 67
APS_Lab 0:f06ed53310a3 68 //ADC Command Configurations
APS_Lab 0:f06ed53310a3 69 //const uint8_t ADC_OPT = ADC_OPT_DISABLED; // See LTC6811_daisy.h for Options
APS_Lab 0:f06ed53310a3 70 const uint8_t ADC_CONVERSION_MODE = MD_7KHZ_3KHZ;//MD_7KHZ_3KHZ; //MD_26HZ_2KHZ;//MD_7KHZ_3KHZ; // See LTC6811_daisy.h for Options
APS_Lab 0:f06ed53310a3 71 const uint8_t ADC_DCP = DCP_DISABLED; // See LTC6811_daisy.h for Options
APS_Lab 0:f06ed53310a3 72 const uint8_t CELL_CH_TO_CONVERT = CELL_CH_ALL; // See LTC6811_daisy.h for Options
APS_Lab 0:f06ed53310a3 73 const uint8_t AUX_CH_TO_CONVERT = AUX_CH_ALL; // See LTC6811_daisy.h for Options
APS_Lab 0:f06ed53310a3 74 const uint8_t STAT_CH_TO_CONVERT = STAT_CH_ALL; // See LTC6811_daisy.h for Options
APS_Lab 0:f06ed53310a3 75
takuma1 2:3bbbe439ec11 76 const uint16_t MEASUREMENT_LOOP_TIME = 100;//milliseconds(mS)
APS_Lab 0:f06ed53310a3 77
APS_Lab 0:f06ed53310a3 78 //Under Voltage and Over Voltage Thresholds
takuma1 2:3bbbe439ec11 79 const uint16_t OV_THRESHOLD = 41000; //
takuma1 2:3bbbe439ec11 80 const uint16_t UV_THRESHOLD = 30000; //
APS_Lab 0:f06ed53310a3 81
APS_Lab 0:f06ed53310a3 82 //Loop Measurement Setup These Variables are ENABLED or DISABLED Remember ALL CAPS
APS_Lab 0:f06ed53310a3 83 const uint8_t WRITE_CONFIG = DISABLED; // This is ENABLED or DISABLED
APS_Lab 0:f06ed53310a3 84 const uint8_t READ_CONFIG = DISABLED; // This is ENABLED or DISABLED
APS_Lab 0:f06ed53310a3 85 const uint8_t MEASURE_CELL = ENABLED; // This is ENABLED or DISABLED
APS_Lab 0:f06ed53310a3 86 const uint8_t MEASURE_AUX = DISABLED; // This is ENABLED or DISABLED
APS_Lab 0:f06ed53310a3 87 const uint8_t MEASURE_STAT = DISABLED; //This is ENABLED or DISABLED
APS_Lab 0:f06ed53310a3 88 const uint8_t PRINT_PEC = DISABLED; //This is ENABLED or DISABLED
takuma1 2:3bbbe439ec11 89 short n =0;
APS_Lab 0:f06ed53310a3 90
APS_Lab 0:f06ed53310a3 91 uint8_t read_data();
APS_Lab 0:f06ed53310a3 92
APS_Lab 0:f06ed53310a3 93 float read_float();
APS_Lab 0:f06ed53310a3 94
takuma1 2:3bbbe439ec11 95
APS_Lab 0:f06ed53310a3 96 int32_t read_int();
APS_Lab 0:f06ed53310a3 97
takuma1 2:3bbbe439ec11 98 int BAT_MIN, BAT_MAX, BAT_AVG;
takuma1 2:3bbbe439ec11 99 double BAT_Current;
takuma1 2:3bbbe439ec11 100 long BAT_SUM;
takuma1 2:3bbbe439ec11 101 unsigned short BAT_CELL[27];
APS_Lab 0:f06ed53310a3 102
takuma1 2:3bbbe439ec11 103 char *read_string();
takuma1 2:3bbbe439ec11 104 int8_t read_char();
APS_Lab 0:f06ed53310a3 105
APS_Lab 0:f06ed53310a3 106 cell_asic bms_ic[TOTAL_IC];
APS_Lab 0:f06ed53310a3 107
APS_Lab 0:f06ed53310a3 108 int main(void)
APS_Lab 0:f06ed53310a3 109 {
APS_Lab 0:f06ed53310a3 110 uint32_t user_command;
APS_Lab 0:f06ed53310a3 111
APS_Lab 0:f06ed53310a3 112 pc.baud(115200);
takuma1 2:3bbbe439ec11 113
takuma1 2:3bbbe439ec11 114 while(1) {
takuma1 2:3bbbe439ec11 115 BAT_MIN = 0;
takuma1 2:3bbbe439ec11 116 BAT_MAX = 0; // 0にする
takuma1 2:3bbbe439ec11 117 ic_set();
takuma1 2:3bbbe439ec11 118 }
takuma1 2:3bbbe439ec11 119 }
takuma1 2:3bbbe439ec11 120
takuma1 2:3bbbe439ec11 121
takuma1 2:3bbbe439ec11 122
takuma1 2:3bbbe439ec11 123 void ic_set(){
takuma1 2:3bbbe439ec11 124
takuma1 2:3bbbe439ec11 125 //__disable_irq();
takuma1 2:3bbbe439ec11 126 ic_check();
takuma1 2:3bbbe439ec11 127 spi_check();
takuma1 2:3bbbe439ec11 128 spi_error();
takuma1 2:3bbbe439ec11 129 wakeup();
takuma1 2:3bbbe439ec11 130 cell_read();
takuma1 2:3bbbe439ec11 131
takuma1 2:3bbbe439ec11 132 }
takuma1 2:3bbbe439ec11 133
takuma1 2:3bbbe439ec11 134 void ic_check(){ //1
takuma1 2:3bbbe439ec11 135
takuma1 2:3bbbe439ec11 136 //__disable_irq();
takuma1 2:3bbbe439ec11 137 pc.baud(115200);
APS_Lab 0:f06ed53310a3 138 spi_enable();
APS_Lab 0:f06ed53310a3 139 LTC681x_init_cfg(TOTAL_IC, bms_ic);
APS_Lab 0:f06ed53310a3 140 LTC6811_reset_crc_count(TOTAL_IC,bms_ic);
APS_Lab 0:f06ed53310a3 141 LTC6811_init_reg_limits(TOTAL_IC,bms_ic);
takuma1 2:3bbbe439ec11 142 wakeup_sleep(TOTAL_IC);
takuma1 2:3bbbe439ec11 143 LTC6811_wrcfg(TOTAL_IC,bms_ic);
takuma1 2:3bbbe439ec11 144 print_config();
takuma1 2:3bbbe439ec11 145 //printf("1");
takuma1 2:3bbbe439ec11 146 //spi_check();
takuma1 2:3bbbe439ec11 147
takuma1 2:3bbbe439ec11 148 }
takuma1 2:3bbbe439ec11 149
takuma1 2:3bbbe439ec11 150 void spi_check(){ //2
APS_Lab 0:f06ed53310a3 151
takuma1 2:3bbbe439ec11 152 __disable_irq();
takuma1 2:3bbbe439ec11 153 int countup;
takuma1 2:3bbbe439ec11 154 int8_t error = 0;
takuma1 2:3bbbe439ec11 155
takuma1 2:3bbbe439ec11 156 wakeup_sleep(TOTAL_IC);
takuma1 2:3bbbe439ec11 157 error = LTC6811_rdcfg(TOTAL_IC,bms_ic);
takuma1 2:3bbbe439ec11 158 check_error(error);
takuma1 2:3bbbe439ec11 159 print_rxconfig();
takuma1 2:3bbbe439ec11 160 //printf("2");
takuma1 2:3bbbe439ec11 161 //spi_error();
takuma1 2:3bbbe439ec11 162 }
APS_Lab 0:f06ed53310a3 163
takuma1 2:3bbbe439ec11 164
takuma1 2:3bbbe439ec11 165 void wakeup(){ //3
APS_Lab 0:f06ed53310a3 166
takuma1 2:3bbbe439ec11 167 __disable_irq();
takuma1 2:3bbbe439ec11 168 int countup;
APS_Lab 0:f06ed53310a3 169 int8_t error = 0;
APS_Lab 0:f06ed53310a3 170 uint32_t conv_time = 0;
takuma1 2:3bbbe439ec11 171
takuma1 2:3bbbe439ec11 172
APS_Lab 0:f06ed53310a3 173 wakeup_sleep(TOTAL_IC);
APS_Lab 0:f06ed53310a3 174 LTC6811_adcv(ADC_CONVERSION_MODE,ADC_DCP,CELL_CH_TO_CONVERT);
APS_Lab 0:f06ed53310a3 175 conv_time = LTC6811_pollAdc();
takuma1 2:3bbbe439ec11 176 //printf("3");
takuma1 2:3bbbe439ec11 177 //cell_read();
takuma1 2:3bbbe439ec11 178 }
takuma1 2:3bbbe439ec11 179
takuma1 2:3bbbe439ec11 180
takuma1 2:3bbbe439ec11 181 void spi_error(){
takuma1 2:3bbbe439ec11 182
takuma1 2:3bbbe439ec11 183 //__disable_irq();
takuma1 2:3bbbe439ec11 184
takuma1 2:3bbbe439ec11 185 int8_t error = 0;
takuma1 2:3bbbe439ec11 186 int countup;
takuma1 2:3bbbe439ec11 187 /*
takuma1 2:3bbbe439ec11 188 if(error = -1 ){
takuma1 2:3bbbe439ec11 189 for(countup = 0; countup <= 2; countup++){
takuma1 2:3bbbe439ec11 190 spi_check();
takuma1 2:3bbbe439ec11 191 if(error =1){
takuma1 2:3bbbe439ec11 192 break;
takuma1 2:3bbbe439ec11 193 }
takuma1 2:3bbbe439ec11 194 }
takuma1 2:3bbbe439ec11 195 }
takuma1 2:3bbbe439ec11 196 if(error = 1){
takuma1 2:3bbbe439ec11 197 wakeup();
takuma1 2:3bbbe439ec11 198 }
takuma1 2:3bbbe439ec11 199 */
takuma1 2:3bbbe439ec11 200
takuma1 2:3bbbe439ec11 201 //wakeup();
takuma1 2:3bbbe439ec11 202
takuma1 2:3bbbe439ec11 203
takuma1 2:3bbbe439ec11 204 }
takuma1 2:3bbbe439ec11 205
takuma1 2:3bbbe439ec11 206 void cell_read(){ //4 電圧読み取り
APS_Lab 0:f06ed53310a3 207
takuma1 2:3bbbe439ec11 208 __disable_irq();
takuma1 2:3bbbe439ec11 209 int8_t error = 0;
takuma1 2:3bbbe439ec11 210 uint32_t conv_time = 0;
takuma1 2:3bbbe439ec11 211 int8_t readIC=0;
takuma1 2:3bbbe439ec11 212
takuma1 2:3bbbe439ec11 213 wakeup_sleep(TOTAL_IC);
takuma1 2:3bbbe439ec11 214 error = LTC6811_rdcv(0, TOTAL_IC,bms_ic);
takuma1 2:3bbbe439ec11 215 check_error(error);
takuma1 2:3bbbe439ec11 216 //print_cells(DATALOG_DISABLED);
takuma1 2:3bbbe439ec11 217 print_CAN(DATALOG_DISABLED);
takuma1 2:3bbbe439ec11 218 //printf("4");
takuma1 2:3bbbe439ec11 219
takuma1 2:3bbbe439ec11 220 }
takuma1 2:3bbbe439ec11 221
takuma1 2:3bbbe439ec11 222
APS_Lab 0:f06ed53310a3 223
takuma1 2:3bbbe439ec11 224
takuma1 2:3bbbe439ec11 225 void print_CAN(uint8_t datalog_en){
takuma1 2:3bbbe439ec11 226
takuma1 2:3bbbe439ec11 227 __disable_irq();
takuma1 2:3bbbe439ec11 228 short n =0;
takuma1 2:3bbbe439ec11 229 int BAT_SUM = 0; // 0にする
takuma1 2:3bbbe439ec11 230 int BAT_MIN = 55876;
takuma1 2:3bbbe439ec11 231 double V,C;
takuma1 2:3bbbe439ec11 232 int BTA_MAX = 0;
takuma1 2:3bbbe439ec11 233 float tempC, sum, sum_2, ave, ave_2;
takuma1 2:3bbbe439ec11 234 int i, j, k, l; //平均化処理に使用
takuma1 2:3bbbe439ec11 235 int r = 5; //平均する値の個数
takuma1 2:3bbbe439ec11 236
takuma1 2:3bbbe439ec11 237 for (int current_ic = 0 ; current_ic < TOTAL_IC; current_ic++) {
takuma1 2:3bbbe439ec11 238
takuma1 2:3bbbe439ec11 239 //if (datalog_en == 0) {
takuma1 2:3bbbe439ec11 240 //pc.printf("IC%d, ", current_ic+1);
takuma1 2:3bbbe439ec11 241 //for(n = 0; n <= 12; n++){
takuma1 2:3bbbe439ec11 242 for (int i=0; i < bms_ic[0].ic_reg.cell_channels; i++) {
takuma1 2:3bbbe439ec11 243
takuma1 2:3bbbe439ec11 244 //BAT_CELL[n] = bms_ic[current_ic].cells.c_codes[i];
takuma1 2:3bbbe439ec11 245
takuma1 2:3bbbe439ec11 246
takuma1 2:3bbbe439ec11 247 pc.printf("C%d:", i+1);
takuma1 2:3bbbe439ec11 248 pc.printf("%.4f, ",bms_ic[current_ic].cells.c_codes[i]*0.0001);
takuma1 2:3bbbe439ec11 249 BAT_SUM = bms_ic[current_ic].cells.c_codes[i] + BAT_SUM;
takuma1 2:3bbbe439ec11 250
takuma1 2:3bbbe439ec11 251 if(bms_ic[current_ic].cells.c_codes[i] > 10000){
takuma1 2:3bbbe439ec11 252 if(bms_ic[current_ic].cells.c_codes[i] < BAT_MIN){
takuma1 2:3bbbe439ec11 253 BAT_MIN = bms_ic[current_ic].cells.c_codes[i];
takuma1 2:3bbbe439ec11 254 }
takuma1 2:3bbbe439ec11 255 }
takuma1 2:3bbbe439ec11 256
takuma1 2:3bbbe439ec11 257 if( bms_ic[current_ic].cells.c_codes[i] > BAT_MAX){
takuma1 2:3bbbe439ec11 258 BAT_MAX = bms_ic[current_ic].cells.c_codes[i];
takuma1 2:3bbbe439ec11 259
takuma1 2:3bbbe439ec11 260 }
takuma1 2:3bbbe439ec11 261
takuma1 3:61174d4de67d 262 /*
takuma1 2:3bbbe439ec11 263
takuma1 2:3bbbe439ec11 264 //平均化処理
takuma1 2:3bbbe439ec11 265
takuma1 2:3bbbe439ec11 266 sum = 0;
takuma1 2:3bbbe439ec11 267 ave = 0;
takuma1 2:3bbbe439ec11 268 i = 0;
takuma1 2:3bbbe439ec11 269 for( i = 0; i < r; i++)
takuma1 2:3bbbe439ec11 270 {
takuma1 2:3bbbe439ec11 271 float temp = max.read_temp();
takuma1 2:3bbbe439ec11 272 sum += temp;
takuma1 2:3bbbe439ec11 273 }
takuma1 2:3bbbe439ec11 274
takuma1 2:3bbbe439ec11 275 ave = sum / r;
takuma1 2:3bbbe439ec11 276 printf("\n\rT: %f",ave );
takuma1 2:3bbbe439ec11 277
takuma1 2:3bbbe439ec11 278
takuma1 2:3bbbe439ec11 279
takuma1 2:3bbbe439ec11 280 max.deselect();
takuma1 2:3bbbe439ec11 281 max_2.select_2();
takuma1 2:3bbbe439ec11 282
takuma1 2:3bbbe439ec11 283 //平均化処理
takuma1 2:3bbbe439ec11 284 sum_2 = 0;
takuma1 2:3bbbe439ec11 285 ave_2 = 0;
takuma1 2:3bbbe439ec11 286 j = 0;
takuma1 2:3bbbe439ec11 287 for( j = 0; j < r; j++)
takuma1 2:3bbbe439ec11 288 {
takuma1 2:3bbbe439ec11 289 float temp_2 = max_2.read_temp_2();
takuma1 2:3bbbe439ec11 290 sum_2 += temp_2;
takuma1 2:3bbbe439ec11 291 }
takuma1 2:3bbbe439ec11 292
takuma1 2:3bbbe439ec11 293 ave_2 = sum_2 / r;
takuma1 2:3bbbe439ec11 294 printf("\n\rT: %f",ave_2 );
takuma1 2:3bbbe439ec11 295
takuma1 2:3bbbe439ec11 296
takuma1 2:3bbbe439ec11 297
takuma1 2:3bbbe439ec11 298 max.deselect();
takuma1 2:3bbbe439ec11 299 max_2.deselect_2();
takuma1 2:3bbbe439ec11 300
takuma1 2:3bbbe439ec11 301
takuma1 2:3bbbe439ec11 302
takuma1 2:3bbbe439ec11 303 max.deselect();
takuma1 2:3bbbe439ec11 304 max_2.deselect_2();
takuma1 2:3bbbe439ec11 305
takuma1 2:3bbbe439ec11 306
takuma1 2:3bbbe439ec11 307
takuma1 2:3bbbe439ec11 308
takuma1 2:3bbbe439ec11 309 //BAT_Current = C;
takuma1 2:3bbbe439ec11 310
takuma1 3:61174d4de67d 311 */
takuma1 2:3bbbe439ec11 312
takuma1 2:3bbbe439ec11 313
APS_Lab 0:f06ed53310a3 314 }
APS_Lab 0:f06ed53310a3 315
takuma1 2:3bbbe439ec11 316 }
takuma1 2:3bbbe439ec11 317
takuma1 2:3bbbe439ec11 318
takuma1 2:3bbbe439ec11 319 pc.printf("\n");
takuma1 2:3bbbe439ec11 320 pc.printf("SUM");
takuma1 2:3bbbe439ec11 321 pc.printf("%.4f, ",BAT_SUM*0.0001);
takuma1 2:3bbbe439ec11 322 BAT_AVG = BAT_SUM / 27;
takuma1 2:3bbbe439ec11 323 pc.printf("AVG");
takuma1 2:3bbbe439ec11 324 pc.printf("%.4f, ",BAT_AVG*0.0001);
takuma1 2:3bbbe439ec11 325 pc.printf("MIN");
takuma1 2:3bbbe439ec11 326 pc.printf("%.4f, ",BAT_MIN*0.0001);
takuma1 2:3bbbe439ec11 327 pc.printf("MAX");
takuma1 2:3bbbe439ec11 328 pc.printf("%.4f, ",BAT_MAX*0.0001);
takuma1 2:3bbbe439ec11 329 //pc.printf("BAT_Current");
takuma1 2:3bbbe439ec11 330 if((VCmonitor.getVoltage(&V) == 0) && (VCmonitor.getCurrent(&C) == 0)){
takuma1 2:3bbbe439ec11 331 printf("V,%f,C,%f\n",V,C);
takuma1 2:3bbbe439ec11 332 BAT_Current = C;
takuma1 2:3bbbe439ec11 333
takuma1 2:3bbbe439ec11 334 }
takuma1 2:3bbbe439ec11 335 pc.printf("%f, ",BAT_Current);
takuma1 2:3bbbe439ec11 336 pc.printf("\n");
takuma1 2:3bbbe439ec11 337 pc.printf("\n");
takuma1 2:3bbbe439ec11 338 printf("\n\rT: %f",ave );
takuma1 2:3bbbe439ec11 339 pc.printf("\n");
takuma1 2:3bbbe439ec11 340 printf("\n\rT: %f",ave_2 );
takuma1 2:3bbbe439ec11 341 pc.printf("\n");
takuma1 2:3bbbe439ec11 342
takuma1 2:3bbbe439ec11 343 if( BAT_MIN < 25000 ){
takuma1 2:3bbbe439ec11 344 BAT_MIN_safty = 1 ;
takuma1 2:3bbbe439ec11 345 wait(1);
takuma1 2:3bbbe439ec11 346 BAT_MIN_safty = 0 ;
takuma1 2:3bbbe439ec11 347 }
takuma1 2:3bbbe439ec11 348 if( BAT_MAX > 42000){
takuma1 2:3bbbe439ec11 349 BAT_MAX_safty = 1;
takuma1 2:3bbbe439ec11 350 wait(1);
takuma1 2:3bbbe439ec11 351 BAT_MAX_safty = 0;
takuma1 2:3bbbe439ec11 352
takuma1 2:3bbbe439ec11 353 }
takuma1 2:3bbbe439ec11 354 }
takuma1 2:3bbbe439ec11 355
takuma1 2:3bbbe439ec11 356
takuma1 2:3bbbe439ec11 357 /*
takuma1 2:3bbbe439ec11 358 void can_sent4(){
takuma1 2:3bbbe439ec11 359
takuma1 2:3bbbe439ec11 360 if(can1.write(CANMessage(271,&BAT_MAX2))){
takuma1 2:3bbbe439ec11 361 pc.printf("10CANMessage:%d\n",BAT_MAX2);
takuma1 2:3bbbe439ec11 362 }
takuma1 2:3bbbe439ec11 363 if(can1.write(CANMessage(272,&BAT_MAX3))){
takuma1 2:3bbbe439ec11 364 pc.printf("11CANMessage:%d\n",BAT_MAX3);
takuma1 2:3bbbe439ec11 365 }
takuma1 2:3bbbe439ec11 366 if(can1.write(CANMessage(273,&BAT_MAX4))){
takuma1 2:3bbbe439ec11 367 pc.printf("12CANMessage:%d\n",BAT_MAX4);
takuma1 2:3bbbe439ec11 368 }
takuma1 2:3bbbe439ec11 369
takuma1 2:3bbbe439ec11 370 }*/
takuma1 2:3bbbe439ec11 371 /*
takuma1 2:3bbbe439ec11 372 void can_set(){
takuma1 2:3bbbe439ec11 373
takuma1 2:3bbbe439ec11 374 //NVIC_SetPriority(TIMER3_IRQn, 0);
takuma1 2:3bbbe439ec11 375 //printf("aaaaa");
takuma1 2:3bbbe439ec11 376
takuma1 2:3bbbe439ec11 377 BAT_SUM1 = 0;
takuma1 2:3bbbe439ec11 378 BAT_SUM2 = 0;
takuma1 2:3bbbe439ec11 379 BAT_SUM3 = 0;
takuma1 2:3bbbe439ec11 380 BAT_SUM4 = 0;
takuma1 2:3bbbe439ec11 381 BAT_MIN1 = 0;
takuma1 2:3bbbe439ec11 382 BAT_MIN2 = 0;
takuma1 2:3bbbe439ec11 383 BAT_MIN3 = 0;
takuma1 2:3bbbe439ec11 384 BAT_MIN4 = 0;
takuma1 2:3bbbe439ec11 385 BAT_MAX1 = 0;
takuma1 2:3bbbe439ec11 386 BAT_MAX2 = 0;
takuma1 2:3bbbe439ec11 387 BAT_MAX3 = 0;
takuma1 2:3bbbe439ec11 388 BAT_MAX4 = 0;
takuma1 2:3bbbe439ec11 389 BAT_Current1 = 0;
takuma1 2:3bbbe439ec11 390 BAT_Current2 = 0;
takuma1 2:3bbbe439ec11 391
takuma1 2:3bbbe439ec11 392
takuma1 2:3bbbe439ec11 393 int data1 = 0; //BAT_SUM
takuma1 2:3bbbe439ec11 394 int data2 = 0;
takuma1 2:3bbbe439ec11 395 int data3 = 0; //BAT_MAX
takuma1 2:3bbbe439ec11 396 int data4 = 0; //BAT_Current
takuma1 2:3bbbe439ec11 397
APS_Lab 0:f06ed53310a3 398
takuma1 2:3bbbe439ec11 399 BAT_SUM = data1;
takuma1 2:3bbbe439ec11 400 data2 = BAT_MIN;
takuma1 2:3bbbe439ec11 401 data3 = BAT_MAX;
takuma1 2:3bbbe439ec11 402 data4 = BAT_Current;
takuma1 2:3bbbe439ec11 403
takuma1 2:3bbbe439ec11 404 BAT_SUM1 = data1 / 1000; //114
takuma1 2:3bbbe439ec11 405 BAT_SUM2 = data1 % 1000; //755
takuma1 2:3bbbe439ec11 406 BAT_SUM3 = BAT_SUM2 / 10; //75
takuma1 2:3bbbe439ec11 407 BAT_SUM4 = BAT_SUM2 % 10; // 5
takuma1 2:3bbbe439ec11 408
takuma1 2:3bbbe439ec11 409 BAT_MIN1 = data2 / 1000;
takuma1 2:3bbbe439ec11 410 BAT_MIN2 = data2 % 1000;
takuma1 2:3bbbe439ec11 411 BAT_MIN3 = BAT_MIN2 / 10;
takuma1 2:3bbbe439ec11 412 BAT_MIN4 = BAT_MIN2 % 10;
takuma1 2:3bbbe439ec11 413
takuma1 2:3bbbe439ec11 414 BAT_MAX = data3 / 1000;
takuma1 2:3bbbe439ec11 415 BAT_MAX2 = data3 % 1000;
takuma1 2:3bbbe439ec11 416 BAT_MAX3 = BAT_MAX2 / 10;
takuma1 2:3bbbe439ec11 417 BAT_MAX4 = BAT_MAX2 % 10;
takuma1 2:3bbbe439ec11 418
takuma1 2:3bbbe439ec11 419 BAT_Current1 = data4 / 100;
takuma1 2:3bbbe439ec11 420 BAT_Current2 = data4 % 100;
takuma1 2:3bbbe439ec11 421 printf("can_set\n");
takuma1 2:3bbbe439ec11 422 printf("aaaa%f",BAT_SUM);
APS_Lab 0:f06ed53310a3 423 }
takuma1 2:3bbbe439ec11 424 */
takuma1 2:3bbbe439ec11 425
APS_Lab 0:f06ed53310a3 426 void measurement_loop(uint8_t datalog_en)
APS_Lab 0:f06ed53310a3 427 {
APS_Lab 0:f06ed53310a3 428 int8_t error = 0;
APS_Lab 0:f06ed53310a3 429 if (WRITE_CONFIG == ENABLED) {
APS_Lab 0:f06ed53310a3 430 wakeup_sleep(TOTAL_IC);
APS_Lab 0:f06ed53310a3 431 LTC6811_wrcfg(TOTAL_IC,bms_ic);
APS_Lab 0:f06ed53310a3 432 print_config();
APS_Lab 0:f06ed53310a3 433 }
APS_Lab 0:f06ed53310a3 434
APS_Lab 0:f06ed53310a3 435 if (READ_CONFIG == ENABLED) {
APS_Lab 0:f06ed53310a3 436 wakeup_sleep(TOTAL_IC);
APS_Lab 0:f06ed53310a3 437 error = LTC6811_rdcfg(TOTAL_IC,bms_ic);
APS_Lab 0:f06ed53310a3 438 check_error(error);
APS_Lab 0:f06ed53310a3 439 print_rxconfig();
APS_Lab 0:f06ed53310a3 440 }
APS_Lab 0:f06ed53310a3 441
APS_Lab 0:f06ed53310a3 442 if (MEASURE_CELL == ENABLED) {
APS_Lab 0:f06ed53310a3 443 wakeup_idle(TOTAL_IC);
APS_Lab 0:f06ed53310a3 444 LTC6811_adcv(ADC_CONVERSION_MODE,ADC_DCP,CELL_CH_TO_CONVERT);
APS_Lab 0:f06ed53310a3 445 LTC6811_pollAdc();
APS_Lab 0:f06ed53310a3 446 wakeup_idle(TOTAL_IC);
APS_Lab 0:f06ed53310a3 447 error = LTC6811_rdcv(0, TOTAL_IC,bms_ic);
APS_Lab 0:f06ed53310a3 448 check_error(error);
APS_Lab 0:f06ed53310a3 449 print_cells(datalog_en);
APS_Lab 0:f06ed53310a3 450
APS_Lab 0:f06ed53310a3 451 }
APS_Lab 0:f06ed53310a3 452
APS_Lab 0:f06ed53310a3 453 if (MEASURE_AUX == ENABLED) {
APS_Lab 0:f06ed53310a3 454 wakeup_idle(TOTAL_IC);
APS_Lab 0:f06ed53310a3 455 LTC6811_adax(ADC_CONVERSION_MODE , AUX_CH_ALL);
APS_Lab 0:f06ed53310a3 456 LTC6811_pollAdc();
APS_Lab 0:f06ed53310a3 457 wakeup_idle(TOTAL_IC);
APS_Lab 0:f06ed53310a3 458 error = LTC6811_rdaux(0,TOTAL_IC,bms_ic); // Set to read back all aux registers
APS_Lab 0:f06ed53310a3 459 check_error(error);
APS_Lab 0:f06ed53310a3 460 print_aux(datalog_en);
APS_Lab 0:f06ed53310a3 461 }
APS_Lab 0:f06ed53310a3 462
APS_Lab 0:f06ed53310a3 463 if (MEASURE_STAT == ENABLED) {
APS_Lab 0:f06ed53310a3 464 wakeup_idle(TOTAL_IC);
APS_Lab 0:f06ed53310a3 465 LTC6811_adstat(ADC_CONVERSION_MODE, STAT_CH_ALL);
APS_Lab 0:f06ed53310a3 466 LTC6811_pollAdc();
APS_Lab 0:f06ed53310a3 467 wakeup_idle(TOTAL_IC);
APS_Lab 0:f06ed53310a3 468 error = LTC6811_rdstat(0,TOTAL_IC,bms_ic); // Set to read back all aux registers
APS_Lab 0:f06ed53310a3 469 check_error(error);
APS_Lab 0:f06ed53310a3 470 print_stat();
APS_Lab 0:f06ed53310a3 471 }
APS_Lab 0:f06ed53310a3 472
APS_Lab 0:f06ed53310a3 473 if (PRINT_PEC == ENABLED) {
APS_Lab 0:f06ed53310a3 474 print_pec();
APS_Lab 0:f06ed53310a3 475 }
APS_Lab 0:f06ed53310a3 476
APS_Lab 0:f06ed53310a3 477 }
APS_Lab 0:f06ed53310a3 478
APS_Lab 0:f06ed53310a3 479
APS_Lab 0:f06ed53310a3 480
APS_Lab 0:f06ed53310a3 481 void print_cells(uint8_t datalog_en)
APS_Lab 0:f06ed53310a3 482 {
APS_Lab 0:f06ed53310a3 483 for (int current_ic = 0 ; current_ic < TOTAL_IC; current_ic++) {
APS_Lab 0:f06ed53310a3 484
APS_Lab 0:f06ed53310a3 485 if (datalog_en == 0) {
APS_Lab 0:f06ed53310a3 486 pc.printf("IC%d, ", current_ic+1);
takuma1 2:3bbbe439ec11 487 for (int i=0; i < bms_ic[0].ic_reg.cell_channels; i++) {
APS_Lab 0:f06ed53310a3 488 pc.printf("C%d:", i+1);
APS_Lab 0:f06ed53310a3 489 pc.printf("%.4f, ", bms_ic[current_ic].cells.c_codes[i]*0.0001);
takuma1 2:3bbbe439ec11 490 }
takuma1 2:3bbbe439ec11 491
APS_Lab 0:f06ed53310a3 492 pc.printf("\n");
takuma1 2:3bbbe439ec11 493 }
takuma1 2:3bbbe439ec11 494
takuma1 2:3bbbe439ec11 495 else {
APS_Lab 0:f06ed53310a3 496 pc.printf("Cells, ");
APS_Lab 0:f06ed53310a3 497 for (int i=0; i<bms_ic[0].ic_reg.cell_channels; i++) {
takuma1 2:3bbbe439ec11 498 pc.printf("%.4f, ",bms_ic[current_ic].cells.c_codes[i]*0.0001);
takuma1 2:3bbbe439ec11 499
APS_Lab 0:f06ed53310a3 500 }
APS_Lab 0:f06ed53310a3 501 }
takuma1 2:3bbbe439ec11 502
APS_Lab 0:f06ed53310a3 503 }
APS_Lab 0:f06ed53310a3 504 pc.printf("\n");
APS_Lab 0:f06ed53310a3 505 }
APS_Lab 0:f06ed53310a3 506
APS_Lab 0:f06ed53310a3 507 void print_open()
APS_Lab 0:f06ed53310a3 508 {
APS_Lab 0:f06ed53310a3 509 for (int current_ic =0 ; current_ic < TOTAL_IC; current_ic++) {
APS_Lab 0:f06ed53310a3 510 if (bms_ic[current_ic].system_open_wire == 0) {
APS_Lab 0:f06ed53310a3 511 pc.printf("No Opens Detected on IC%d\n", current_ic+1);
APS_Lab 0:f06ed53310a3 512 } else {
APS_Lab 0:f06ed53310a3 513 for (int cell=0; cell<bms_ic[0].ic_reg.cell_channels+1; cell++) {
APS_Lab 0:f06ed53310a3 514 if ((bms_ic[current_ic].system_open_wire &(1<<cell))>0) {
APS_Lab 0:f06ed53310a3 515 pc.printf("There is an open wire on IC%d Channel: %d\n", current_ic + 1, cell);
APS_Lab 0:f06ed53310a3 516 }
APS_Lab 0:f06ed53310a3 517 }
APS_Lab 0:f06ed53310a3 518 }
APS_Lab 0:f06ed53310a3 519 }
APS_Lab 0:f06ed53310a3 520 }
APS_Lab 0:f06ed53310a3 521
takuma1 2:3bbbe439ec11 522
APS_Lab 0:f06ed53310a3 523 void print_aux(uint8_t datalog_en)
APS_Lab 0:f06ed53310a3 524 {
APS_Lab 0:f06ed53310a3 525
APS_Lab 0:f06ed53310a3 526 for (int current_ic =0 ; current_ic < TOTAL_IC; current_ic++) {
APS_Lab 0:f06ed53310a3 527 if (datalog_en == 0) {
APS_Lab 0:f06ed53310a3 528 pc.printf(" IC%d", current_ic+1);
APS_Lab 0:f06ed53310a3 529 for (int i=0; i < 5; i++) {
APS_Lab 0:f06ed53310a3 530 pc.printf(" GPIO-%d:%.4f,", i+1, bms_ic[current_ic].aux.a_codes[i]*0.0001);
APS_Lab 0:f06ed53310a3 531 }
APS_Lab 0:f06ed53310a3 532 pc.printf("Vref2:%.4f\n", bms_ic[current_ic].aux.a_codes[5]*0.0001);
APS_Lab 0:f06ed53310a3 533 } else {
APS_Lab 0:f06ed53310a3 534 pc.printf("AUX, ");
APS_Lab 0:f06ed53310a3 535 for (int i=0; i < 6; i++) {
APS_Lab 0:f06ed53310a3 536 pc.printf("%.4f,", bms_ic[current_ic].aux.a_codes[i]*0.0001);
APS_Lab 0:f06ed53310a3 537 }
APS_Lab 0:f06ed53310a3 538 }
APS_Lab 0:f06ed53310a3 539 }
APS_Lab 0:f06ed53310a3 540 pc.printf("\n");
APS_Lab 0:f06ed53310a3 541 }
APS_Lab 0:f06ed53310a3 542
takuma1 2:3bbbe439ec11 543
APS_Lab 0:f06ed53310a3 544 void print_stat()
APS_Lab 0:f06ed53310a3 545 {
APS_Lab 0:f06ed53310a3 546
APS_Lab 0:f06ed53310a3 547 for (int current_ic =0 ; current_ic < TOTAL_IC; current_ic++) {
APS_Lab 0:f06ed53310a3 548 pc.printf("IC%d", current_ic+1);
APS_Lab 0:f06ed53310a3 549 pc.printf(" SOC:%.4f,", bms_ic[current_ic].stat.stat_codes[0]*0.0001*20);
APS_Lab 0:f06ed53310a3 550 pc.printf(" Itemp:%.4f,", bms_ic[current_ic].stat.stat_codes[1]*0.0001);
APS_Lab 0:f06ed53310a3 551 pc.printf(" VregA:%.4f,", bms_ic[current_ic].stat.stat_codes[2]*0.0001);
APS_Lab 0:f06ed53310a3 552 pc.printf(" VregD:%.4f\n", bms_ic[current_ic].stat.stat_codes[3]*0.0001);
APS_Lab 0:f06ed53310a3 553 }
APS_Lab 0:f06ed53310a3 554
APS_Lab 0:f06ed53310a3 555 pc.printf("\n");
APS_Lab 0:f06ed53310a3 556 }
APS_Lab 0:f06ed53310a3 557
takuma1 2:3bbbe439ec11 558
APS_Lab 0:f06ed53310a3 559 void print_config()
APS_Lab 0:f06ed53310a3 560 {
APS_Lab 0:f06ed53310a3 561 int cfg_pec;
APS_Lab 0:f06ed53310a3 562
takuma1 2:3bbbe439ec11 563 //pc.printf("Written Configuration: \n");
APS_Lab 0:f06ed53310a3 564 for (int current_ic = 0; current_ic<TOTAL_IC; current_ic++) {
takuma1 2:3bbbe439ec11 565 //pc.printf(" IC ");
takuma1 2:3bbbe439ec11 566 //pc.printf("%d", current_ic+1);
takuma1 2:3bbbe439ec11 567 // pc.printf(": ");
takuma1 2:3bbbe439ec11 568 //pc.printf("0x");
APS_Lab 0:f06ed53310a3 569 serial_print_hex(bms_ic[current_ic].config.tx_data[0]);
takuma1 2:3bbbe439ec11 570 // pc.printf(", 0x");
APS_Lab 0:f06ed53310a3 571 serial_print_hex(bms_ic[current_ic].config.tx_data[1]);
takuma1 2:3bbbe439ec11 572 //pc.printf(", 0x");
APS_Lab 0:f06ed53310a3 573 serial_print_hex(bms_ic[current_ic].config.tx_data[2]);
takuma1 2:3bbbe439ec11 574 //pc.printf(", 0x");
APS_Lab 0:f06ed53310a3 575 serial_print_hex(bms_ic[current_ic].config.tx_data[3]);
takuma1 2:3bbbe439ec11 576 // pc.printf(", 0x");
APS_Lab 0:f06ed53310a3 577 serial_print_hex(bms_ic[current_ic].config.tx_data[4]);
takuma1 2:3bbbe439ec11 578 // pc.printf(", 0x");
APS_Lab 0:f06ed53310a3 579 serial_print_hex(bms_ic[current_ic].config.tx_data[5]);
takuma1 2:3bbbe439ec11 580 //pc.printf(", Calculated PEC: 0x");
APS_Lab 0:f06ed53310a3 581 cfg_pec = pec15_calc(6,&bms_ic[current_ic].config.tx_data[0]);
APS_Lab 0:f06ed53310a3 582 serial_print_hex((uint8_t)(cfg_pec>>8));
takuma1 2:3bbbe439ec11 583 //pc.printf(", 0x");
APS_Lab 0:f06ed53310a3 584 serial_print_hex((uint8_t)(cfg_pec));
takuma1 2:3bbbe439ec11 585 // pc.printf("\n");
APS_Lab 0:f06ed53310a3 586 }
takuma1 2:3bbbe439ec11 587 // pc.printf("\n");
APS_Lab 0:f06ed53310a3 588 }
APS_Lab 0:f06ed53310a3 589
takuma1 2:3bbbe439ec11 590
APS_Lab 0:f06ed53310a3 591 void print_rxconfig()
APS_Lab 0:f06ed53310a3 592 {
takuma1 2:3bbbe439ec11 593 //pc.printf("Received Configuration ");
APS_Lab 0:f06ed53310a3 594 for (int current_ic=0; current_ic<TOTAL_IC; current_ic++) {
takuma1 2:3bbbe439ec11 595 // pc.printf(" IC ");
takuma1 2:3bbbe439ec11 596 // pc.printf("%d", current_ic+1);
takuma1 2:3bbbe439ec11 597 //pc.printf(": 0x");
APS_Lab 0:f06ed53310a3 598 serial_print_hex(bms_ic[current_ic].config.rx_data[0]);
takuma1 2:3bbbe439ec11 599 //pc.printf(", 0x");
APS_Lab 0:f06ed53310a3 600 serial_print_hex(bms_ic[current_ic].config.rx_data[1]);
takuma1 2:3bbbe439ec11 601 //pc.printf(", 0x");
APS_Lab 0:f06ed53310a3 602 serial_print_hex(bms_ic[current_ic].config.rx_data[2]);
takuma1 2:3bbbe439ec11 603 //pc.printf(", 0x");
APS_Lab 0:f06ed53310a3 604 serial_print_hex(bms_ic[current_ic].config.rx_data[3]);
takuma1 2:3bbbe439ec11 605 //pc.printf(", 0x");
APS_Lab 0:f06ed53310a3 606 serial_print_hex(bms_ic[current_ic].config.rx_data[4]);
takuma1 2:3bbbe439ec11 607 // pc.printf(", 0x");
APS_Lab 0:f06ed53310a3 608 serial_print_hex(bms_ic[current_ic].config.rx_data[5]);
takuma1 2:3bbbe439ec11 609 //pc.printf(", Received PEC: 0x");
APS_Lab 0:f06ed53310a3 610 serial_print_hex(bms_ic[current_ic].config.rx_data[6]);
takuma1 2:3bbbe439ec11 611 //pc.printf(", 0x");
APS_Lab 0:f06ed53310a3 612 serial_print_hex(bms_ic[current_ic].config.rx_data[7]);
takuma1 2:3bbbe439ec11 613 // pc.printf("\n");
APS_Lab 0:f06ed53310a3 614 }
APS_Lab 0:f06ed53310a3 615 pc.printf("\n");
APS_Lab 0:f06ed53310a3 616 }
APS_Lab 0:f06ed53310a3 617
APS_Lab 0:f06ed53310a3 618 void print_pec()
APS_Lab 0:f06ed53310a3 619 {
APS_Lab 0:f06ed53310a3 620 for (int current_ic=0; current_ic<TOTAL_IC; current_ic++) {
APS_Lab 0:f06ed53310a3 621 pc.printf("\n%d", bms_ic[current_ic].crc_count.pec_count);
APS_Lab 0:f06ed53310a3 622 pc.printf(" : PEC Errors Detected on IC");
APS_Lab 0:f06ed53310a3 623 pc.printf("%d\n", current_ic+1);
APS_Lab 0:f06ed53310a3 624 }
APS_Lab 0:f06ed53310a3 625 }
APS_Lab 0:f06ed53310a3 626
APS_Lab 0:f06ed53310a3 627
APS_Lab 0:f06ed53310a3 628 void serial_print_hex(uint8_t data)
APS_Lab 0:f06ed53310a3 629 {
takuma1 2:3bbbe439ec11 630 /*
APS_Lab 0:f06ed53310a3 631 if (data < 16) {
takuma1 2:3bbbe439ec11 632 //pc.printf("0x0%X", data);
APS_Lab 0:f06ed53310a3 633 } else
takuma1 2:3bbbe439ec11 634 pc.printf("0x%X", data);
takuma1 2:3bbbe439ec11 635 */
APS_Lab 0:f06ed53310a3 636 }
APS_Lab 0:f06ed53310a3 637
APS_Lab 0:f06ed53310a3 638 //Function to check error flag and print PEC error message
APS_Lab 0:f06ed53310a3 639 void check_error(int error)
APS_Lab 0:f06ed53310a3 640 {
APS_Lab 0:f06ed53310a3 641 if (error == -1) {
APS_Lab 0:f06ed53310a3 642 pc.printf("A PEC error was detected in the received data");
APS_Lab 0:f06ed53310a3 643 }
APS_Lab 0:f06ed53310a3 644 }
APS_Lab 0:f06ed53310a3 645
APS_Lab 0:f06ed53310a3 646
takuma1 2:3bbbe439ec11 647
APS_Lab 0:f06ed53310a3 648 char hex_digits[16]= {
APS_Lab 0:f06ed53310a3 649 '0', '1', '2', '3', '4', '5', '6', '7', '8', '9', 'A', 'B', 'C', 'D', 'E', 'F'
APS_Lab 0:f06ed53310a3 650 };
APS_Lab 0:f06ed53310a3 651
takuma1 2:3bbbe439ec11 652
APS_Lab 0:f06ed53310a3 653
APS_Lab 0:f06ed53310a3 654 char hex_to_byte_buffer[5]= {
APS_Lab 0:f06ed53310a3 655 '0', 'x', '0', '0', '\0'
APS_Lab 0:f06ed53310a3 656 }; // buffer for ASCII hex to byte conversion
APS_Lab 0:f06ed53310a3 657 char byte_to_hex_buffer[3]= {
APS_Lab 0:f06ed53310a3 658 '\0','\0','\0'
APS_Lab 0:f06ed53310a3 659 };
APS_Lab 0:f06ed53310a3 660
takuma1 2:3bbbe439ec11 661 // シリアル インターフェイスから ui_バッファへのデータの読み取り
APS_Lab 0:f06ed53310a3 662 uint8_t read_data()
APS_Lab 0:f06ed53310a3 663 {
takuma1 2:3bbbe439ec11 664 uint8_t index = 0; // 内の現在の場所を保持するインデックス
takuma1 2:3bbbe439ec11 665 int c; // 着信キーストロークの格納に使用される単一の文字
APS_Lab 0:f06ed53310a3 666 //pc.printf("check 1\n");
APS_Lab 0:f06ed53310a3 667 while (index < UI_BUFFER_SIZE-1) {
APS_Lab 0:f06ed53310a3 668 //pc.printf("check 2\n");
takuma1 2:3bbbe439ec11 669 c = pc.getc();
APS_Lab 0:f06ed53310a3 670 //return c;
APS_Lab 0:f06ed53310a3 671 //pc.printf("check 3\n");
APS_Lab 0:f06ed53310a3 672
takuma1 2:3bbbe439ec11 673 if (((char) c == '\r') || ((char) c == '\n')) break;
takuma1 2:3bbbe439ec11 674 if ( ((char) c == '\x7F') || ((char) c == '\x08') ) {
APS_Lab 0:f06ed53310a3 675 if (index > 0) index--;
APS_Lab 0:f06ed53310a3 676 } else if (c >= 0) {
takuma1 2:3bbbe439ec11 677 ui_buffer[index++]=(char) c;
APS_Lab 0:f06ed53310a3 678 }
APS_Lab 0:f06ed53310a3 679 //pc.printf("check 4\n");
APS_Lab 0:f06ed53310a3 680
APS_Lab 0:f06ed53310a3 681 }
takuma1 2:3bbbe439ec11 682 ui_buffer[index]='\0';
APS_Lab 0:f06ed53310a3 683
takuma1 2:3bbbe439ec11 684 if ((char) c == '\r') {
APS_Lab 0:f06ed53310a3 685 wait_ms(1);
APS_Lab 0:f06ed53310a3 686 //pc.printf("check 5\n");
APS_Lab 0:f06ed53310a3 687
APS_Lab 0:f06ed53310a3 688 if (pc.readable()==1) {
APS_Lab 0:f06ed53310a3 689 //pc.printf("check 6\n");
takuma1 2:3bbbe439ec11 690 pc.getc();
APS_Lab 0:f06ed53310a3 691 }
takuma1 2:3bbbe439ec11 692
APS_Lab 0:f06ed53310a3 693
APS_Lab 0:f06ed53310a3 694 }
takuma1 2:3bbbe439ec11 695
APS_Lab 0:f06ed53310a3 696
takuma1 2:3bbbe439ec11 697 return index;
APS_Lab 0:f06ed53310a3 698 }
APS_Lab 0:f06ed53310a3 699
takuma1 2:3bbbe439ec11 700
APS_Lab 0:f06ed53310a3 701 float read_float()
APS_Lab 0:f06ed53310a3 702 {
APS_Lab 0:f06ed53310a3 703 float data;
APS_Lab 0:f06ed53310a3 704 read_data();
APS_Lab 0:f06ed53310a3 705 data = atof(ui_buffer);
APS_Lab 0:f06ed53310a3 706 return(data);
APS_Lab 0:f06ed53310a3 707 }
APS_Lab 0:f06ed53310a3 708
takuma1 2:3bbbe439ec11 709
APS_Lab 0:f06ed53310a3 710 int32_t read_int()
APS_Lab 0:f06ed53310a3 711 {
APS_Lab 0:f06ed53310a3 712 int32_t data;
APS_Lab 0:f06ed53310a3 713 read_data();
APS_Lab 0:f06ed53310a3 714 if (ui_buffer[0] == 'm')
APS_Lab 0:f06ed53310a3 715 return('m');
APS_Lab 0:f06ed53310a3 716 if ((ui_buffer[0] == 'B') || (ui_buffer[0] == 'b')) {
APS_Lab 0:f06ed53310a3 717 data = strtol(ui_buffer+1, NULL, 2);
APS_Lab 0:f06ed53310a3 718 } else
APS_Lab 0:f06ed53310a3 719 data = strtol(ui_buffer, NULL, 0);
APS_Lab 0:f06ed53310a3 720 return(data);
APS_Lab 0:f06ed53310a3 721 }
APS_Lab 0:f06ed53310a3 722
APS_Lab 0:f06ed53310a3 723 char *read_string()
APS_Lab 0:f06ed53310a3 724 {
APS_Lab 0:f06ed53310a3 725 read_data();
APS_Lab 0:f06ed53310a3 726 return(ui_buffer);
APS_Lab 0:f06ed53310a3 727 }
APS_Lab 0:f06ed53310a3 728
takuma1 2:3bbbe439ec11 729
APS_Lab 0:f06ed53310a3 730 int8_t read_char()
APS_Lab 0:f06ed53310a3 731 {
APS_Lab 0:f06ed53310a3 732 read_data();
APS_Lab 0:f06ed53310a3 733 return(ui_buffer[0]);
APS_Lab 0:f06ed53310a3 734 }