Rev 351 | Rev 354 | Go to most recent revision | Show entire file | Regard whitespace | Details | Blame | Last modification | View Log | SVN | RSS feed
| Rev 351 | Rev 352 | ||
|---|---|---|---|
| Line 20... | Line 20... | ||
| 20 | *---------------------------------------------------------------------------*/ |
20 | *---------------------------------------------------------------------------*/ |
| 21 | /* system files */ |
21 | /* system files */ |
| 22 | #include <avr/io.h> |
22 | #include <avr/io.h> |
| 23 | #include <avr/interrupt.h> |
23 | #include <avr/interrupt.h> |
| 24 | #include <stdio.h> |
24 | #include <stdio.h> |
| - | 25 | #include <avr/wdt.h> |
|
| 25 | /* lib files */ |
26 | /* lib files */ |
| 26 | #include <bios.h> |
27 | #include <bios.h> |
| 27 | #include <tc1047.h> |
28 | #include <tc1047.h> |
| 28 | #include <funcdefs.h> |
29 | #include <funcdefs.h> |
| 29 | 30 | ||
| 30 | /* defines */ |
31 | /* defines */ |
| 31 | #define GROUP_ID |
32 | #define GROUP_ID 0x01UL |
| 32 | 33 | ||
| 33 | #define RELAY_OFF |
34 | #define RELAY_OFF 0x01UL |
| 34 | #define RELAY_ON |
35 | #define RELAY_ON 0x02UL |
| 35 | #define FAILSAFE_MODE |
36 | #define FAILSAFE_MODE 0x0FUL |
| 36 | #define FAILSAFE_TRESHOLD 60 /* Degrees when nodeRelay goes into failsafe mode */ |
37 | #define FAILSAFE_TRESHOLD 60 /* Degrees when nodeRelay goes into failsafe mode */ |
| 37 | 38 | ||
| 38 | #define RELAY_CMD_ON |
39 | #define RELAY_CMD_ON 0x01UL |
| 39 | #define RELAY_CMD_OFF |
40 | #define RELAY_CMD_OFF 0x02UL |
| 40 | #define RELAY_CMD_TOGGLE |
41 | #define RELAY_CMD_TOGGLE 0x03UL |
| 41 | #define RELAY_CMD_STATUS |
42 | #define RELAY_CMD_STATUS 0x04UL |
| 42 | #define RELAY_CMD_RESET |
43 | #define RELAY_CMD_RESET 0x05UL |
| 43 | #define STATUS_SEND_PERIOD 10000 /* milliseconds */ |
44 | #define STATUS_SEND_PERIOD 10000 /* milliseconds */ |
| 44 | #define FAILSAFE_SEND_PERIOD 10000 /* milliseconds */ |
45 | #define FAILSAFE_SEND_PERIOD 10000 /* milliseconds */ |
| 45 | #define BOUNCE_TIME 10 /* milliseconds */ |
46 | #define BOUNCE_TIME 10 /* milliseconds */ |
| 46 | #define BUTTON1 1 |
47 | #define BUTTON1 1 |
| 47 | #define BUTTON2 2 |
48 | #define BUTTON2 2 |
| Line 51... | Line 52... | ||
| 51 | * -----------------------------------------------------------------------*/ |
52 | * -----------------------------------------------------------------------*/ |
| 52 | #if TWO_BUTTON_MODE |
53 | #if TWO_BUTTON_MODE |
| 53 | Can_Message_t txMsg_Button; |
54 | Can_Message_t txMsg_Button; |
| 54 | #endif |
55 | #endif |
| 55 | 56 | ||
| 56 | uint8_t relayStatus, failsafe_flag; |
57 | uint8_t relayStatus, failsafe_flag = 0; |
| 57 | uint32_t boardTemperature = 0; |
58 | uint32_t boardTemperature = 0; |
| 58 | Can_Message_t txMsg; |
59 | Can_Message_t txMsg; |
| 59 | 60 | ||
| 60 | /*---------------------------------------------------------------------------- |
61 | /*---------------------------------------------------------------------------- |
| 61 | * Functions |
62 | * Functions |
| Line 64... | Line 65... | ||
| 64 | uint8_t relayOn(); |
65 | uint8_t relayOn(); |
| 65 | void relayFailsafe(); |
66 | void relayFailsafe(); |
| 66 | 67 | ||
| 67 | void can_receive(Can_Message_t *msg){ |
68 | void can_receive(Can_Message_t *msg){ |
| 68 | uint32_t act; |
69 | uint32_t act; |
| 69 |
|
70 | uint32_t m, act_type, group, node; |
| 70 | 71 | ||
| 71 | if( ((msg->Id & CLASS_MASK)>>CLASS_MASK_BITS) == CLASS_ACT){ |
72 | if( ((msg->Id & CLASS_MASK)>>CLASS_MASK_BITS) == CLASS_ACT){ |
| 72 | 73 | ||
| 73 | act = (msg->Id & TYPE_MASK) >> TYPE_MASK_BITS; |
74 | act = (msg->Id & TYPE_MASK) >> TYPE_MASK_BITS; |
| 74 | act_type = (act & ACT_TYPE_MASK) >> ACT_TYPE_BITS; |
75 | act_type = (act & ACT_TYPE_MASK) >> ACT_TYPE_BITS; |
| 75 | group = (act & ACT_GROUP_MASK) >> ACT_GROUP_BITS; |
76 | group = (act & ACT_GROUP_MASK) >> ACT_GROUP_BITS; |
| 76 | node = (act & ACT_NODE_MASK) >> ACT_NODE_BITS; |
77 | node = (act & ACT_NODE_MASK) >> ACT_NODE_BITS; |
| 77 | 78 | ||
| 78 | if( act_type == ACT_TYPE_RELAY && (group == GROUP_ID || node == NODE_ID) ){ |
79 | if( act_type == ACT_TYPE_RELAY && (group == GROUP_ID || node == NODE_ID) ){ |
| 79 | if(msg->Data.bytes[0] == RELAY_CMD_ON){ |
80 | if(msg->Data.bytes[0] == RELAY_CMD_ON && !failsafe_flag){ |
| 80 | // Turn relay on |
81 | // Turn relay on |
| 81 | relayStatus = relayOn(); |
82 | relayStatus = relayOn(); |
| 82 | 83 | ||
| 83 | }else if(msg->Data.bytes[0] == RELAY_CMD_OFF){ |
84 | }else if(msg->Data.bytes[0] == RELAY_CMD_OFF && !failsafe_flag){ |
| 84 | // Turn relay off |
85 | // Turn relay off |
| 85 | relayStatus = relayOff(); |
86 | relayStatus = relayOff(); |
| - | 87 | txMsg.Id = 0x8000111UL; // FIXME |
|
| - | 88 | bios->can_send(&txMsg); |
|
| 86 | 89 | ||
| 87 | }else if(msg->Data.bytes[0] == RELAY_CMD_TOGGLE ){ |
90 | }else if(msg->Data.bytes[0] == RELAY_CMD_TOGGLE && !failsafe_flag){ |
| 88 | // Toggle relay |
91 | // Toggle relay |
| 89 | if(relayStatus == RELAY_OFF){ |
92 | if(relayStatus == RELAY_OFF){ |
| 90 | relayStatus = relayOn(); |
93 | relayStatus = relayOn(); |
| 91 | }else{ |
94 | }else{ |
| 92 | relayStatus = relayOff(); |
95 | relayStatus = relayOff(); |
| - | 96 | txMsg.Id = 0x8000113UL; // FIXME |
|
| - | 97 | bios->can_send(&txMsg); |
|
| 93 | } |
98 | } |
| 94 | 99 | ||
| 95 | }else if(msg->Data.bytes[0] == RELAY_CMD_STATUS){ |
100 | }else if(msg->Data.bytes[0] == RELAY_CMD_STATUS && !failsafe_flag){ |
| 96 | // Send relay status to CAN |
101 | // Send relay status to CAN |
| 97 | boardTemperature = getTC1047temperature(); |
102 | boardTemperature = getTC1047temperature(); |
| 98 | 103 | ||
| 99 | if( (int32_t)boardTemperature >= FAILSAFE_TRESHOLD ){ |
104 | if( (int32_t)boardTemperature >= FAILSAFE_TRESHOLD ){ |
| 100 | // Goto failsafe mode |
105 | // Goto failsafe mode |
| Line 102... | Line 107... | ||
| 102 | }else{ |
107 | }else{ |
| 103 | // Transmitt node status |
108 | // Transmitt node status |
| 104 | txMsg.Data.bytes[0] = boardTemperature & 0x00FF; |
109 | txMsg.Data.bytes[0] = boardTemperature & 0x00FF; |
| 105 | txMsg.Data.bytes[1] = (boardTemperature & 0xFF00)>>8; |
110 | txMsg.Data.bytes[1] = (boardTemperature & 0xFF00)>>8; |
| 106 | txMsg.Data.bytes[2] = relayStatus; |
111 | txMsg.Data.bytes[2] = relayStatus; |
| 107 | txMsg. |
112 | txMsg.Data.bytes[3] = 0; |
| - | 113 | txMsg.Id = ( CLASS_SNS<<CLASS_MASK_BITS )|( SNS_ACT_STATUS_RELAY<<TYPE_MASK_BITS )|(NODE_ID); |
|
| 108 | bios->can_send( &txMsg ); |
114 | bios->can_send( &txMsg ); |
| 109 | } |
115 | } |
| 110 | }else if(msg->Data.bytes[0] == RELAY_CMD_RESET){ |
116 | }else if(msg->Data.bytes[0] == RELAY_CMD_RESET){ |
| 111 | // Return to normal operation |
117 | // Return to normal operation |
| 112 | failsafe_flag = |
118 | failsafe_flag = 0; |
| 113 | } |
119 | } |
| 114 | } |
120 | } |
| 115 | } |
121 | } |
| 116 | } |
122 | } |
| 117 | 123 | ||
| Line 190... | Line 196... | ||
| 190 | // Control channel for relay |
196 | // Control channel for relay |
| 191 | DDRC |= (1<<DDC1); |
197 | DDRC |= (1<<DDC1); |
| 192 | 198 | ||
| 193 | // Set up callback for CAN messages |
199 | // Set up callback for CAN messages |
| 194 | bios->can_callback = &can_receive; |
200 | bios->can_callback = &can_receive; |
| 195 | - | ||
| 196 | sei(); |
- | |
| 197 | - | ||
| 198 | // Turn relay off |
- | |
| 199 | relayStatus = relayOff(); |
- | |
| 200 | - | ||
| 201 | uint32_t timeStamp = 0; |
- | |
| 202 | 201 | ||
| 203 | txMsg.RemoteFlag = 0; |
202 | txMsg.RemoteFlag = 0; |
| 204 | txMsg.ExtendedFlag = 1; |
203 | txMsg.ExtendedFlag = 1; |
| - | 204 | txMsg.DataLength = 4; |
|
| - | 205 | ||
| - | 206 | sei(); |
|
| - | 207 | ||
| - | 208 | // Turn relay off |
|
| - | 209 | relayStatus = relayOff(); |
|
| 205 | txMsg.Id = |
210 | txMsg.Id = 0x8000110UL; // FIXME |
| - | 211 | bios->can_send(&txMsg); |
|
| - | 212 | ||
| - | 213 | uint32_t timeStamp = 0; |
|
| - | 214 | ||
| 206 | 215 | ||
| 207 | // Main loop |
216 | // Main loop |
| 208 | while (1) { |
217 | while (1) { |
| 209 | 218 | ||
| 210 | if( bios->timebase_get() - timeStamp >= STATUS_SEND_PERIOD ){ |
219 | if( bios->timebase_get() - timeStamp >= STATUS_SEND_PERIOD ){ |
| 211 | timeStamp = bios->timebase_get(); |
220 | timeStamp = bios->timebase_get(); |
| Line 217... | Line 226... | ||
| 217 | relayFailsafe(); |
226 | relayFailsafe(); |
| 218 | }else{ |
227 | }else{ |
| 219 | txMsg.Data.bytes[0] = boardTemperature & 0x00FF; |
228 | txMsg.Data.bytes[0] = boardTemperature & 0x00FF; |
| 220 | txMsg.Data.bytes[1] = (boardTemperature & 0xFF00)>>8; |
229 | txMsg.Data.bytes[1] = (boardTemperature & 0xFF00)>>8; |
| 221 | txMsg.Data.bytes[2] = relayStatus; |
230 | txMsg.Data.bytes[2] = relayStatus; |
| 222 | txMsg. |
231 | txMsg.Data.bytes[3] = 0; |
| - | 232 | txMsg.Id = ( CLASS_SNS<<CLASS_MASK_BITS )|( SNS_ACT_STATUS_RELAY<<TYPE_MASK_BITS )|(NODE_ID); |
|
| 223 | bios->can_send( &txMsg ); |
233 | bios->can_send( &txMsg ); |
| 224 | } |
234 | } |
| 225 | } |
235 | } |
| 226 | } |
236 | } |
| 227 | return 0; |
237 | return 0; |
| Line 229... | Line 239... | ||
| 229 | 239 | ||
| 230 | uint8_t relayOff() |
240 | uint8_t relayOff() |
| 231 | { |
241 | { |
| 232 | // Turn off relay |
242 | // Turn off relay |
| 233 | PORTC &= ~(1<<PC1); |
243 | PORTC &= ~(1<<PC1); |
| - | 244 | DDRC |= (1<<DDC1); // FIXME |
|
| 234 | 245 | ||
| 235 | return RELAY_OFF; |
246 | return RELAY_OFF; |
| 236 | } |
247 | } |
| 237 | 248 | ||
| 238 | uint8_t relayOn() |
249 | uint8_t relayOn() |
| 239 | { |
250 | { |
| 240 | // Turn on relay |
251 | // Turn on relay |
| - | 252 | DDRC &= ~(1<<DDC1); // FIXME |
|
| 241 | PORTC |= (1<<PC1); |
253 | PORTC |= (1<<PC1); |
| 242 | 254 | ||
| 243 | return RELAY_ON; |
255 | return RELAY_ON; |
| 244 | } |
256 | } |
| 245 | 257 | ||
| 246 | void relayFailsafe() |
258 | void relayFailsafe() |
| 247 | { |
259 | { |
| 248 | uint32_t timeStamp = 0; |
260 | uint32_t timeStamp = 0; |
| 249 | 261 | ||
| 250 | relayStatus = relayOff(); |
262 | relayStatus = relayOff(); |
| 251 | failsafe_flag = |
263 | failsafe_flag = 1; |
| 252 | 264 | ||
| 253 | while(1){ |
265 | while(1){ |
| 254 | 266 | ||
| 255 | if( failsafe_flag ){ |
267 | if( !failsafe_flag ){ |
| 256 | // Return from failsafe mode |
268 | // Return from failsafe mode |
| 257 | return; |
269 | return; |
| 258 | } |
270 | } |
| 259 | 271 | ||
| 260 | if( bios->timebase_get() - timeStamp >= FAILSAFE_SEND_PERIOD ){ |
272 | if( bios->timebase_get() - timeStamp >= FAILSAFE_SEND_PERIOD ){ |
| Line 264... | Line 276... | ||
| 264 | 276 | ||
| 265 | txMsg.Data.bytes[0] = boardTemperature & 0x00FF; |
277 | txMsg.Data.bytes[0] = boardTemperature & 0x00FF; |
| 266 | txMsg.Data.bytes[1] = (boardTemperature & 0xFF00)>>8; |
278 | txMsg.Data.bytes[1] = (boardTemperature & 0xFF00)>>8; |
| 267 | txMsg.Data.bytes[2] = relayStatus; |
279 | txMsg.Data.bytes[2] = relayStatus; |
| 268 | txMsg.Data.bytes[3] = FAILSAFE_MODE; |
280 | txMsg.Data.bytes[3] = FAILSAFE_MODE; |
| - | 281 | txMsg.Id = ( CLASS_SNS<<CLASS_MASK_BITS )|( SNS_ACT_STATUS_RELAY<<TYPE_MASK_BITS )|(NODE_ID); |
|
| 269 | 282 | ||
| 270 | bios->can_send( &txMsg ); |
283 | bios->can_send( &txMsg ); |
| 271 | } |
284 | } |
| 272 | } |
285 | } |
| 273 | } |
286 | } |