|
|
|
@ -34,7 +34,7 @@ void do_kraftsensor(){
|
|
|
|
kraftsensor_valid = 1;
|
|
|
|
kraftsensor_valid = 1;
|
|
|
|
int32_t tmp = (uint32_t)m_data[0]<<16;
|
|
|
|
int32_t tmp = (uint32_t)m_data[0]<<16;
|
|
|
|
tmp |= m_data[1];
|
|
|
|
tmp |= m_data[1];
|
|
|
|
kraftsensor_value = tmp;
|
|
|
|
kraftsensor_value = ((tmp + 539363)*9.81)/177.380;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|