Rev 1145 | Rev 1147 | Go to most recent revision | Show entire file | Regard whitespace | Details | Blame | Last modification | View Log | SVN | RSS feed
| Rev 1145 | Rev 1146 | ||
|---|---|---|---|
| Line 30... | Line 30... | ||
| 30 | StdCan_Set_class(txMsg.Header, CAN_MODULE_CLASS_SNS); |
30 | StdCan_Set_class(txMsg.Header, CAN_MODULE_CLASS_SNS); |
| 31 | StdCan_Set_direction(txMsg.Header, DIRECTIONFLAG_FROM_OWNER); |
31 | StdCan_Set_direction(txMsg.Header, DIRECTIONFLAG_FROM_OWNER); |
| 32 | txMsg.Header.ModuleType = CAN_MODULE_TYPE_SNS_FOST02; |
32 | txMsg.Header.ModuleType = CAN_MODULE_TYPE_SNS_FOST02; |
| 33 | txMsg.Header.ModuleId = sns_FOST02_ID; |
33 | txMsg.Header.ModuleId = sns_FOST02_ID; |
| 34 | txMsg.Header.Command = CAN_MODULE_CMD_PHYSICAL_TEMPERATURE_CELSIUS; |
34 | txMsg.Header.Command = CAN_MODULE_CMD_PHYSICAL_TEMPERATURE_CELSIUS; |
| 35 | txMsg.Length = |
35 | txMsg.Length = 3; |
| 36 | txMsg.Data[0] = FOST02_ID; |
36 | txMsg.Data[0] = FOST02_ID; |
| 37 | - | ||
| 38 | 37 | ||
| 39 | getFOST02DataByte(&byte1, &byte2); |
38 | getFOST02DataByte(&byte1, &byte2); |
| 40 | TmpV = (uint16_t) (byte1<<8) + byte2; |
39 | TmpV = (uint16_t) (byte1<<8) + byte2; |
| 41 | - | ||
| 42 | TmpV = TmpV << 4; |
40 | TmpV = TmpV << 4; |
| 43 | TmpV = TmpV/25; |
41 | TmpV = TmpV/25; |
| 44 | txMsg.Data[3]= (uint8_t) ((TmpV >> 8) & 0x00FF); |
- | |
| 45 | txMsg.Data[4]= (uint8_t) (TmpV & 0x00FF); |
- | |
| 46 | TmpV = TmpV << |
42 | TmpV = TmpV << 2; |
| 47 | TmpV = TmpV- |
43 | TmpV = TmpV-(40*64); |
| 48 | txMsg.Data[2]= (uint8_t) (TmpV & 0xFF); |
44 | txMsg.Data[2]= (uint8_t) (TmpV & 0xFF); |
| 49 | txMsg.Data[1]= (uint8_t) ((TmpV >> 8) & 0xFF); |
45 | txMsg.Data[1]= (uint8_t) ((TmpV >> 8) & 0xFF); |
| 50 | StdCan_Put(&txMsg); |
46 | StdCan_Put(&txMsg); |
| 51 | 47 | ||
| 52 | FlagGetTemperature = 0; |
48 | FlagGetTemperature = 0; |