|
|
@ -12,9 +12,14 @@ |
|
|
|
#include "CANNode.h" |
|
|
|
|
|
|
|
// Configuration
|
|
|
|
#define NODE_ID 0x01 |
|
|
|
// Misc
|
|
|
|
|
|
|
|
#define N_EVENTS 64 // size of events array
|
|
|
|
#define N_SWITCHES 64 // size of switch array
|
|
|
|
#define N_OUTPUTS 64 |
|
|
|
#define N_ACTIONS 64 |
|
|
|
|
|
|
|
#define DEBUG 0 // 1 for noisy serial
|
|
|
|
#define LED 17 |
|
|
|
#define RELAY1 0 |
|
|
@ -52,15 +57,72 @@ |
|
|
|
|
|
|
|
#define DS2406_BUF_LEN 10 |
|
|
|
// Definitions
|
|
|
|
static OW_switch_t switches[N_SWITCHES] PROGMEM= |
|
|
|
{ |
|
|
|
{ 1, { 0x12, 0x5b, 0x27, 0x50, 0x0, 0x0, 0x0, 0x26 }, { 0x01, 0x02 } } |
|
|
|
static uint8_t node_id PROGMEM= { NODE_ID }; |
|
|
|
static OW_switch_t switches[N_SWITCHES] PROGMEM={ |
|
|
|
{ 1, { 0x12, 0x5b, 0x27, 0x50, 0x0, 0x0, 0x0, 0x26 }, { 1, 9 } } |
|
|
|
}; |
|
|
|
static uint8_t switches_state[N_SWITCHES]; |
|
|
|
|
|
|
|
static outputs_t outputs[N_OUTPUTS] PROGMEM={ |
|
|
|
{ GPIO, 0}, |
|
|
|
{ GPIO, 1}, |
|
|
|
{ GPIO, 23}, |
|
|
|
{ GPIO, 22}, |
|
|
|
{ GPIO, 17}, |
|
|
|
{ GPIO, 16}, |
|
|
|
{ GPIO, 9}, |
|
|
|
{ GPIO, 10}, |
|
|
|
{ NOP, 0xFF} |
|
|
|
}; |
|
|
|
static uint8_t outputs_state[N_OUTPUTS]; |
|
|
|
// ID:
|
|
|
|
// 3 bit Prio, 2bit TYPE, 8bit DST, 8bit SRC, 8bit CMD/SEQ
|
|
|
|
// Type: 0: CMD, 1: FIRST, 2: CONT, 3: LAST
|
|
|
|
// CMD:
|
|
|
|
static event_t tx_events[N_EVENTS] PROGMEM={ |
|
|
|
{ 1, 0x03, 0xff, 0x03, 0x01}, |
|
|
|
{ 2, 0x03, 0xff, 0x03, 0x02}, |
|
|
|
{ 3, 0x03, 0xff, 0x03, 0x03}, |
|
|
|
{ 4, 0x03, 0xff, 0x03, 0x04}, |
|
|
|
{ 5, 0x03, 0xff, 0x03, 0x05}, |
|
|
|
{ 6, 0x03, 0xff, 0x03, 0x06}, |
|
|
|
{ 7, 0x03, 0xff, 0x03, 0x07}, |
|
|
|
{ 8, 0x03, 0xff, 0x03, 0x08}, |
|
|
|
{ 9, 0x03, 0xff, 0x03, 0x01}, |
|
|
|
{ 9, 0x03, 0xff, 0x03, 0x02}, |
|
|
|
{ 9, 0x03, 0xff, 0x03, 0x03}, |
|
|
|
{ 9, 0x03, 0xff, 0x03, 0x04}, |
|
|
|
{ 9, 0x03, 0xff, 0x03, 0x05}, |
|
|
|
{ 9, 0x03, 0xff, 0x03, 0x06}, |
|
|
|
{ 9, 0x03, 0xff, 0x03, 0x07}, |
|
|
|
{ 9, 0x03, 0xff, 0x03, 0x08}, |
|
|
|
|
|
|
|
static tx_event_t tx_events[N_EVENTS]; |
|
|
|
// { 0x01, 0x0CFF0103, 1, { 0xDE, 0xAD } },
|
|
|
|
// { 0x01, 0x0102DEAD, 2, { 0xDE, 0xAD } },
|
|
|
|
// { 0x02, 0x0204BEEF, 4, { 0xDE, 0xAD, 0xBE, 0xEF } }
|
|
|
|
}; |
|
|
|
|
|
|
|
static action_t action_map[N_ACTIONS] PROGMEM={ |
|
|
|
{1, 0}; |
|
|
|
{2, 1}; |
|
|
|
{3, 2}; |
|
|
|
{4, 3}; |
|
|
|
{5, 4}; |
|
|
|
{6, 5}; |
|
|
|
{7, 6}; |
|
|
|
{8, 7}; |
|
|
|
{9, 0};{9, 1};{9, 2};{9, 3};{9, 4};{9, 5};{9, 6};{9, 7}; |
|
|
|
} |
|
|
|
// tx_events[0].id =0x01;
|
|
|
|
// tx_events[0].telegram.id = 0x0102DEAD;
|
|
|
|
// tx_events[0].telegram.len = 2;
|
|
|
|
// tx_events[0].telegram.buf[0] = 0xDE;
|
|
|
|
// tx_events[0].telegram.buf[1] = 0xAD;
|
|
|
|
// tx_events[1].id =0x02;
|
|
|
|
// tx_events[1].telegram.id = 0x0204BEEF;
|
|
|
|
// tx_events[1].telegram.len = 4;
|
|
|
|
// tx_events[1].telegram.buf[0] = 0xDE;
|
|
|
|
// tx_events[1].telegram.buf[1] = 0xAD;
|
|
|
|
|
|
|
|
// Initialisation
|
|
|
|
// Misc
|
|
|
@ -86,6 +148,7 @@ uint8_t buffer[DS2406_BUF_LEN]; |
|
|
|
uint8_t readout,trig_event,event_idx,tmp; |
|
|
|
OneWire OW_1(OW_pin); |
|
|
|
|
|
|
|
telegram_comp_t mesg_comp; |
|
|
|
|
|
|
|
static CAN_message_t txmsg,rxmsg; |
|
|
|
static uint8_t hex[17] = "0123456789abcdef"; |
|
|
@ -139,37 +202,42 @@ uint8_t toggle_Pin(uint8_t pin){ |
|
|
|
return digitalRead(pin); |
|
|
|
} |
|
|
|
|
|
|
|
uint32_t forgeid(event_t event){ |
|
|
|
return (event.prio<<26)+(event.dst<<16)+(NODE_ID<<8)+event.cmd; |
|
|
|
} |
|
|
|
|
|
|
|
telegram_comp_t parse_CAN (CAN_telegram_t mesg){ |
|
|
|
telegram_comp_t tmp; |
|
|
|
tmp.prio=mesg.id>>26; |
|
|
|
tmp.frametype=(mesg.id>>24) & 0x03; |
|
|
|
tmp.dst=(mesg.id>>16) & 0xFF; |
|
|
|
tmp.src=(mesg.id>>8) & 0xFF; |
|
|
|
tmp.cmd=mesg.id & 0xFF; |
|
|
|
tmp.length=mesg.length; |
|
|
|
tmp.buff=mesg.buf; |
|
|
|
return tmp; |
|
|
|
} |
|
|
|
|
|
|
|
void take_action (event_type type, uint8_t tag ){ |
|
|
|
for (uint_t i = 0; action_mapaction_map[i].tag != 0 ; i++) { |
|
|
|
if ( action_mapaction_map[i].tag == tag ) { |
|
|
|
switch ( type ) { |
|
|
|
case OFF: |
|
|
|
digitalWrite(outputs[action_mapaction_map[i].outputs_idx].address,LOW); |
|
|
|
break; |
|
|
|
case ON: |
|
|
|
digitalWrite(outputs[action_mapaction_map[i].outputs_idx].address,HIGH); |
|
|
|
break; |
|
|
|
case TOGGLE: |
|
|
|
toggle_Pin(outputs[action_mapaction_map[i].outputs_idx].address); |
|
|
|
break; |
|
|
|
} |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
// -------------------------------------------------------------
|
|
|
|
void setup(void) |
|
|
|
{ |
|
|
|
// Misc
|
|
|
|
// Most clumsy way later to be put in eeprom or s/th
|
|
|
|
// switches[0].id = 1;
|
|
|
|
// switches[0].addr[0] = 0x12,
|
|
|
|
// switches[0].addr[1] = 0x5b;
|
|
|
|
// switches[0].addr[2] = 0x27;
|
|
|
|
// switches[0].addr[3] = 0x50;
|
|
|
|
// switches[0].addr[4] = 0x0;
|
|
|
|
// switches[0].addr[5] = 0x0;
|
|
|
|
// switches[0].addr[6] = 0x0;
|
|
|
|
// switches[0].addr[7] = 0x26;
|
|
|
|
// switches[0].event_id[0] = 0x01;
|
|
|
|
// switches[0].event_id[1] = 0x02;
|
|
|
|
|
|
|
|
tx_events[0].id =0x01; |
|
|
|
tx_events[0].telegram.id = 0x0102DEAD; |
|
|
|
tx_events[0].telegram.len = 2; |
|
|
|
tx_events[0].telegram.buf[0] = 0xDE; |
|
|
|
tx_events[0].telegram.buf[1] = 0xAD; |
|
|
|
tx_events[1].id =0x02; |
|
|
|
tx_events[1].telegram.id = 0x0204BEEF; |
|
|
|
tx_events[1].telegram.len = 4; |
|
|
|
tx_events[1].telegram.buf[0] = 0xDE; |
|
|
|
tx_events[1].telegram.buf[1] = 0xAD; |
|
|
|
tx_events[1].telegram.buf[2] = 0xBE; |
|
|
|
tx_events[1].telegram.buf[3] = 0xEF; |
|
|
|
|
|
|
|
//{ 0x02040608, 2, { 0xbe, 0xef }}};
|
|
|
|
|
|
|
|
Serial.begin(115200); |
|
|
|
pinMode(led, OUTPUT); |
|
|
@ -182,6 +250,12 @@ void setup(void) |
|
|
|
txmsg.ext = 1; |
|
|
|
txmsg.timeout = 100; |
|
|
|
|
|
|
|
// outputs
|
|
|
|
for (size_t i = 0; outputs[i].type != NOP; i++) { |
|
|
|
if (outputs[i].type == GPIO || outputs[i].type == PWM){ |
|
|
|
pinMode(outputs[i].address, OUTPUT); |
|
|
|
} |
|
|
|
} |
|
|
|
|
|
|
|
delay(100); |
|
|
|
Serial.println(F("Hello Teensy 3.2 CANode awakes.")); |
|
|
@ -220,14 +294,14 @@ void loop(void) |
|
|
|
if (action[0]) { |
|
|
|
Serial.print("pioA toggled"); |
|
|
|
digitalWrite(led, !digitalRead(led)); |
|
|
|
trig_event = switches[0].event_id[0]; |
|
|
|
trig_event = switches[0].event_tag[0]; |
|
|
|
// might need queuing
|
|
|
|
event_idx = 0; |
|
|
|
} |
|
|
|
if (action[1]) { |
|
|
|
Serial.print("pioB toggled"); |
|
|
|
digitalWrite(led, !digitalRead(led)); |
|
|
|
trig_event= switches[0].event_id[1]; |
|
|
|
trig_event= switches[0].event_tag[1]; |
|
|
|
event_idx = 0; |
|
|
|
} |
|
|
|
} |
|
|
@ -240,14 +314,15 @@ void loop(void) |
|
|
|
} |
|
|
|
} |
|
|
|
if ( txmsg.len == 0 && trig_event != 0 ) { |
|
|
|
if ( tx_events[event_idx].id == trig_event ) { |
|
|
|
txmsg.id = tx_events[event_idx].telegram.id; |
|
|
|
txmsg.len = tx_events[event_idx].telegram.len; |
|
|
|
for (uint i=0;i<txmsg.len;i++){ |
|
|
|
txmsg.buf[i] = tx_events[event_idx].telegram.buf[i]; |
|
|
|
} |
|
|
|
if ( tx_events[event_idx].tag == trig_event ) { |
|
|
|
txmsg.id = forgeid(tx_events[event_idx]); |
|
|
|
txmsg.len = 1; |
|
|
|
txmsg.buf[0]= tx_events[event_idx].target_id; |
|
|
|
// for (uint i=0;i<txmsg.len;i++){
|
|
|
|
// txmsg.buf[i] = tx_events[event_idx].telegram.buf[i];
|
|
|
|
// }
|
|
|
|
} |
|
|
|
if ( tx_events[event_idx].id == 0) { trig_event = 0; } |
|
|
|
if ( tx_events[event_idx].tag == 0) { trig_event = 0; } |
|
|
|
event_idx++; |
|
|
|
} |
|
|
|
// if not time-delayed, read CAN messages and print 1st byte
|
|
|
@ -273,14 +348,34 @@ void loop(void) |
|
|
|
Serial.print(rxmsg.buf[i],HEX); |
|
|
|
} |
|
|
|
Serial.print("\n"); |
|
|
|
if (rxmsg.id ==0x0102DEAD) { |
|
|
|
state=toggle_Pin(led); |
|
|
|
txmsg.id=0xDEADBEEF; |
|
|
|
txmsg.len=2; |
|
|
|
txmsg.buf[0]=led; |
|
|
|
txmsg.buf[1]=state; |
|
|
|
mesg_comp= parse_CAN(rxmesg) |
|
|
|
if (mesg_comp.dst == 0xFF || mesg_comp.dst == NODE_ID ) { |
|
|
|
|
|
|
|
switch (mesg_comp.cmd) { |
|
|
|
// OFF
|
|
|
|
case 0x00 : |
|
|
|
take_action(OFF, mesg_comp.buf[0]); |
|
|
|
break; |
|
|
|
// ON
|
|
|
|
case 0x01 : |
|
|
|
take_action(ON, mesg_comp.buf[0]); |
|
|
|
break; |
|
|
|
// VALUE
|
|
|
|
case 0x02 : |
|
|
|
break; |
|
|
|
// TOGGLE
|
|
|
|
case 0x03: |
|
|
|
take_action(TOGGLE, mesg_comp.buf[0]); |
|
|
|
break; |
|
|
|
// if (rxmsg.id == 0x0102DEAD) {
|
|
|
|
// state=toggle_Pin(led);
|
|
|
|
// txmsg.id=0xDEADBEEF;
|
|
|
|
// txmsg.len=2;
|
|
|
|
// txmsg.buf[0]=led;
|
|
|
|
// txmsg.buf[1]=state;
|
|
|
|
} |
|
|
|
//#endif
|
|
|
|
} |
|
|
|
rxCount = 0; |
|
|
|
} |
|
|
|
txTimer = 100;//milliseconds
|
|
|
|