mk60 byte order wrong
(cherry picked from commit 9a6a53c9fad43333e29688a73e74ae0fdebb72f0)
This commit is contained in:
parent
a0c512e3b7
commit
3d3873235b
|
@ -34,9 +34,9 @@ expected<uint16_t> look_up_can_id(can_vss_nbc_e type) {
|
||||||
/* Module specitifc processing functions */
|
/* Module specitifc processing functions */
|
||||||
/* source: http://z4evconversion.blogspot.com/2016/07/completely-forgot-but-it-does-live-on.html */
|
/* source: http://z4evconversion.blogspot.com/2016/07/completely-forgot-but-it-does-live-on.html */
|
||||||
float processBMW_e46(const CANRxFrame& frame) {
|
float processBMW_e46(const CANRxFrame& frame) {
|
||||||
/* left front wheel speed is used here */
|
// average the rear wheels since those are the driven ones (more accurate gear detection!)
|
||||||
uint16_t tmp = ((frame.data8[1] & 0x0f) << 8 );
|
uint16_t left = (((frame.data8[5] & 0x0f) << 8) | frame.data8[4]);
|
||||||
tmp |= frame.data8[0];
|
uint16_t right = (((frame.data8[7] & 0x0f) << 8) | frame.data8[6]);
|
||||||
|
|
||||||
return tmp / 16.0f;
|
return tmp / 16.0f;
|
||||||
}
|
}
|
||||||
|
|
Loading…
Reference in New Issue