Rev 352 | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | SVN | RSS feed
| Rev 352 | Rev 354 | ||
|---|---|---|---|
| Line 51... | Line 51... | ||
| 51 | * Global variables |
51 | * Global variables |
| 52 | * -----------------------------------------------------------------------*/ |
52 | * -----------------------------------------------------------------------*/ |
| 53 | #if TWO_BUTTON_MODE |
53 | #if TWO_BUTTON_MODE |
| 54 | Can_Message_t txMsg_Button; |
54 | Can_Message_t txMsg_Button; |
| 55 | #endif |
55 | #endif |
| - | 56 | ||
| 56 | 57 | ||
| 57 | uint8_t relayStatus, failsafe_flag = 0; |
58 | uint8_t relayStatus, failsafe_flag = 0; |
| 58 | uint32_t boardTemperature = 0; |
59 | uint32_t boardTemperature = 0; |
| 59 | Can_Message_t txMsg; |
60 | Can_Message_t txMsg; |
| 60 | 61 | ||
| Line 195... | Line 196... | ||
| 195 | 196 | ||
| 196 | // Control channel for relay |
197 | // Control channel for relay |
| 197 | DDRC |= (1<<DDC1); |
198 | DDRC |= (1<<DDC1); |
| 198 | 199 | ||
| 199 | // Set up callback for CAN messages |
200 | // Set up callback for CAN messages |
| 200 |
|
201 | // bios->can_callback = &can_receive; |
| 201 | 202 | ||
| 202 | txMsg.RemoteFlag = 0; |
203 | txMsg.RemoteFlag = 0; |
| 203 | txMsg.ExtendedFlag = 1; |
204 | txMsg.ExtendedFlag = 1; |
| 204 | txMsg.DataLength = 4; |
205 | txMsg.DataLength = 4; |
| 205 | 206 | ||
| Line 208... | Line 209... | ||
| 208 | // Turn relay off |
209 | // Turn relay off |
| 209 | relayStatus = relayOff(); |
210 | relayStatus = relayOff(); |
| 210 | txMsg.Id = 0x8000110UL; // FIXME |
211 | txMsg.Id = 0x8000110UL; // FIXME |
| 211 | bios->can_send(&txMsg); |
212 | bios->can_send(&txMsg); |
| 212 | 213 | ||
| 213 | uint32_t timeStamp = |
214 | uint32_t timeStamp = bios->timebase_get(), temp; |
| 214 | 215 | ||
| 215 | 216 | ||
| 216 | // Main loop |
217 | // Main loop |
| 217 | while (1) { |
218 | while (1) { |
| 218 | 219 | ||
| - | 220 | temp = bios->timebase_get(); |
|
| 219 | if( |
221 | if( temp - timeStamp >= STATUS_SEND_PERIOD ){ |
| 220 | timeStamp = |
222 | timeStamp = temp; |
| 221 | // Send relay status to CAN |
223 | // Send relay status to CAN |
| 222 | 224 | ||
| 223 |
|
225 | // boardTemperature = getTC1047temperature(); |
| 224 | 226 | ||
| 225 |
|
227 | // if( (int32_t)boardTemperature >= FAILSAFE_TRESHOLD ){ |
| 226 |
|
228 | // relayFailsafe(); |
| 227 |
|
229 | // }else{ |
| 228 | txMsg.Data.bytes[0] = |
230 | txMsg.Data.bytes[0] = timeStamp & 0x000000FF; //boardTemperature & 0x00FF; |
| 229 | txMsg.Data.bytes[1] = ( |
231 | txMsg.Data.bytes[1] = (timeStamp & 0x0000FF00)>>8; //(boardTemperature & 0xFF00)>>8; |
| 230 | txMsg.Data.bytes[2] = |
232 | txMsg.Data.bytes[2] = (timeStamp & 0x00FF0000)>>16; //relayStatus; |
| 231 | txMsg.Data.bytes[3] = |
233 | txMsg.Data.bytes[3] = (timeStamp & 0xFF000000)>>24; //0; |
| 232 | txMsg.Id = ( CLASS_SNS<<CLASS_MASK_BITS )|( SNS_ACT_STATUS_RELAY<<TYPE_MASK_BITS )|(NODE_ID); |
234 | txMsg.Id = ( CLASS_SNS<<CLASS_MASK_BITS )|( SNS_ACT_STATUS_RELAY<<TYPE_MASK_BITS )|(NODE_ID); |
| 233 | bios->can_send( &txMsg ); |
235 | bios->can_send( &txMsg ); |
| 234 |
|
236 | // } |
| 235 | } |
237 | } |
| 236 | } |
238 | } |
| 237 | return 0; |
239 | return 0; |
| 238 | } |
240 | } |
| 239 | 241 | ||