Michel2/Seeed_Arduino_CAN
1
0
Fork 0
mirror of https://github.com/Seeed-Studio/Seeed_Arduino_CAN.git synced 2026-09-15 02:52:53 +00:00
Code Issues Packages Projects Releases Wiki Activity

Ext can id fix

Browse Source
This commit is contained in:
latonita
2016-04-29 20:03:32 +03:00
parent 8180ff092c
commit 0ef9bd7c65
1 changed files with 10 additions and 7 deletions
Download Patch File Download Diff File Expand all files Collapse all files
can-232.cpp
+10 -7
View File
@@ -499,18 +499,21 @@ void Can232::parseCanStdId() {
lw232CanId = (((INT32U)HexHelper::parseNibble(lw232Message[1])) << 8)
+ (((INT32U)HexHelper::parseNibble(lw232Message[2])) << 4)
+ (((INT32U)HexHelper::parseNibble(lw232Message[3])));
lw232CanId &= 0x7FF;
}
void Can232::parseCanExtId() {
lw232CanId = (((INT32U)HexHelper::parseNibble(lw232Message[1])) << 20)
+ (((INT32U)HexHelper::parseNibble(lw232Message[2])) << 16)
+ (((INT32U)HexHelper::parseNibble(lw232Message[3])) << 12)
+ (((INT32U)HexHelper::parseNibble(lw232Message[4])) << 8)
+ (((INT32U)HexHelper::parseNibble(lw232Message[5])) << 4)
+ (((INT32U)HexHelper::parseNibble(lw232Message[6])));
lw232CanId = (((INT32U)HexHelper::parseNibble(lw232Message[1])) << 28)
+ (((INT32U)HexHelper::parseNibble(lw232Message[2])) << 24)
+ (((INT32U)HexHelper::parseNibble(lw232Message[3])) << 20)
+ (((INT32U)HexHelper::parseNibble(lw232Message[4])) << 16)
+ (((INT32U)HexHelper::parseNibble(lw232Message[5])) << 12)
+ (((INT32U)HexHelper::parseNibble(lw232Message[6])) << 8)
+ (((INT32U)HexHelper::parseNibble(lw232Message[7])) << 4)
+ (((INT32U)HexHelper::parseNibble(lw232Message[8])));
lw232CanId &= 0x1FFFFFFF;
}
void HexHelper::printFullByte(INT8U b) {
if (b < 0x10) {
Serial.print('0');