send calibration coeff to controller from CIS

This commit is contained in:
weiting2
2020-01-09 16:03:08 +08:00
parent 3e67933342
commit 69ed093a31
@@ -220,6 +220,9 @@ static void SendCaliValue(uint8_t CaliNumber){
cdr_buf[1] = ch;
cdr_buf[2] = gain_offset;
uint16_t test_u16 = 187;
int16_t test_i16 = -877;
if(gain_offset){
cdr_buf[3] = (uint8_t) (CaliTable.Ch[ch].Offset[0] | 0xFF00) >> 8;
cdr_buf[4] = (uint8_t) CaliTable.Ch[ch].Offset[0] | 0x00FF;
@@ -227,6 +230,13 @@ static void SendCaliValue(uint8_t CaliNumber){
cdr_buf[6] = (uint8_t) CaliTable.Ch[ch].Offset[1] | 0x00FF;
cdr_buf[7] = (uint8_t) (CaliTable.Ch[ch].Offset[2] | 0xFF00) >> 8;
cdr_buf[8] = (uint8_t) CaliTable.Ch[ch].Offset[2] | 0x00FF;
cdr_buf[3] = (uint8_t) (test_i16 | 0xFF00) >> 8;
cdr_buf[4] = (uint8_t) test_i16 | 0x00FF;
cdr_buf[5] = (uint8_t) (test_i16 | 0xFF00) >> 8;
cdr_buf[6] = (uint8_t) test_i16 | 0x00FF;
cdr_buf[7] = (uint8_t) (test_i16 | 0xFF00) >> 8;
cdr_buf[8] = (uint8_t) test_i16 | 0x00FF;
}
else{
cdr_buf[3] = (uint8_t) (CaliTable.Ch[ch].Gain[0] | 0xFF00) >> 8;
@@ -235,13 +245,17 @@ static void SendCaliValue(uint8_t CaliNumber){
cdr_buf[6] = (uint8_t) CaliTable.Ch[ch].Gain[1] | 0x00FF;
cdr_buf[7] = (uint8_t) (CaliTable.Ch[ch].Gain[2] | 0xFF00) >> 8;
cdr_buf[8] = (uint8_t) CaliTable.Ch[ch].Gain[2] | 0x00FF;
cdr_buf[3] = (uint8_t) (test_u16 | 0xFF00) >> 8;
cdr_buf[4] = (uint8_t) test_u16 | 0x00FF;
cdr_buf[5] = (uint8_t) (test_u16 | 0xFF00) >> 8;
cdr_buf[6] = (uint8_t) test_u16 | 0x00FF;
cdr_buf[7] = (uint8_t) (test_u16 | 0xFF00) >> 8;
cdr_buf[8] = (uint8_t) test_u16 | 0x00FF;
}
cdr_buf[3] = 87;
cdr_buf[4] = 87;
cdr_buf[5] = 87;
cdr_buf[6] = 187;
cdr_buf[7] = 187;
cdr_buf[8] = 187;
// CaliTable2u8(u8_cali);
// for(int i=0 ; i<6 ; i++){