send calibration coeff to controller from CIS
This commit is contained in:
+20
-6
@@ -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++){
|
||||
|
||||
Reference in New Issue
Block a user