Rev 1143 | Rev 1145 | Go to most recent revision | Show entire file | Regard whitespace | Details | Blame | Last modification | View Log | SVN | RSS feed
| Rev 1143 | Rev 1144 | ||
|---|---|---|---|
| Line 36... | Line 36... | ||
| 36 | txMsg.Data[0] = FOST02_ID; |
36 | txMsg.Data[0] = FOST02_ID; |
| 37 | 37 | ||
| 38 | 38 | ||
| 39 | getFOST02DataByte(&byte1, &byte2); |
39 | getFOST02DataByte(&byte1, &byte2); |
| 40 | TmpV = (uint16_t) (byte1<<8) + byte2; |
40 | TmpV = (uint16_t) (byte1<<8) + byte2; |
| 41 | txMsg.Data[3]= byte1; |
- | |
| 42 | txMsg.Data[4]= byte2; |
- | |
| 43 | 41 | ||
| 44 | TmpV = TmpV << 4; |
42 | TmpV = TmpV << 4; |
| 45 | TmpV = TmpV/ |
43 | TmpV = TmpV/25; |
| - | 44 | txMsg.Data[3]= (uint8_t) ((TmpV >> 8) & 0x00FF); |
|
| - | 45 | txMsg.Data[4]= (uint8_t) (TmpV & 0x00FF); |
|
| 46 | TmpV= TmpV << |
46 | TmpV= TmpV <<4; |
| 47 | TmpV = TmpV-0x2800; |
47 | TmpV = TmpV-0x2800; |
| 48 | txMsg.Data[2]= (uint8_t) (TmpV & 0x00FF); |
48 | txMsg.Data[2]= (uint8_t) (TmpV & 0x00FF); |
| 49 | txMsg.Data[1]= (uint8_t) ((TmpV >> 8) & 0x00FF); |
49 | txMsg.Data[1]= (uint8_t) ((TmpV >> 8) & 0x00FF); |
| 50 | StdCan_Put(&txMsg); |
50 | StdCan_Put(&txMsg); |
| 51 | 51 | ||