cleanup
This commit is contained in:
Michael Waiblinger
parent
2e39a91a0b
commit
a30292b9f9
@ -106,10 +106,6 @@ void print_OW_Device(uint8_t *addr) {
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
uint8_t read_DS2406(uint8_t* addr) {
|
uint8_t read_DS2406(uint8_t* addr) {
|
||||||
// We're using a temporary switch object here only because we're
|
|
||||||
// discovering them dynamically. Depending on your app, you may
|
|
||||||
// already know the serial number of the device you intend to
|
|
||||||
// control and will use it there.
|
|
||||||
OW_1.reset();
|
OW_1.reset();
|
||||||
OW_1.select(addr);
|
OW_1.select(addr);
|
||||||
OW_1.write(DS2406_CHANNEL_ACCESS,1);
|
OW_1.write(DS2406_CHANNEL_ACCESS,1);
|
||||||
@ -253,22 +249,11 @@ void loop(void)
|
|||||||
rxCount = 0;
|
rxCount = 0;
|
||||||
}
|
}
|
||||||
txTimer = 100;//milliseconds
|
txTimer = 100;//milliseconds
|
||||||
//txmsg.len = 8;
|
|
||||||
//txmsg.id = 0x222;
|
|
||||||
//for( int idx=0; idx<8; ++idx ) {
|
|
||||||
// txmsg.buf[idx] = '0'+idx;
|
|
||||||
//}
|
|
||||||
// send 6 at a time to force tx buffering
|
|
||||||
// txCount = 16;
|
|
||||||
//digitalWrite(led, 1);
|
|
||||||
// Serial.println(".");
|
|
||||||
//while ( txCount-- ) {
|
|
||||||
if (txmsg.len != 0){
|
if (txmsg.len != 0){
|
||||||
Serial.print("Sending to CAN");
|
Serial.print("Sending to CAN");
|
||||||
Serial.print(txmsg.id,HEX);
|
Serial.print(txmsg.id,HEX);
|
||||||
CANbus.write(txmsg);
|
CANbus.write(txmsg);
|
||||||
txmsg.buf[0]++;
|
txmsg.buf[0]++;
|
||||||
//}
|
|
||||||
txmsg.len = 0;
|
txmsg.len = 0;
|
||||||
}
|
}
|
||||||
// digitalWrite(led, 0);
|
// digitalWrite(led, 0);
|
||||||
|
|||||||
282
src/CANode.cpp
282
src/CANode.cpp
@ -1,282 +0,0 @@
|
|||||||
#include <Arduino.h>
|
|
||||||
|
|
||||||
// -------------------------------------------------------------
|
|
||||||
// CANtest for Teensy 3.1
|
|
||||||
// by teachop
|
|
||||||
//
|
|
||||||
// This test is talking to a single other echo-node on the bus.
|
|
||||||
// 6 frames are transmitted and rx frames are counted.
|
|
||||||
// Tx and rx are done in a way to force some driver buffering.
|
|
||||||
// Serial is used to print the ongoing status.
|
|
||||||
//
|
|
||||||
|
|
||||||
#include <Metro.h>
|
|
||||||
#include <FlexCAN.h>
|
|
||||||
#include <OneWire.h>
|
|
||||||
#include "CANode.h"
|
|
||||||
|
|
||||||
// Configurations
|
|
||||||
// Misc
|
|
||||||
#define N_EVENTS 64
|
|
||||||
#define N_SWITCHES 64
|
|
||||||
#define DEBUG 0
|
|
||||||
#define LED 13
|
|
||||||
// Metro
|
|
||||||
#define METRO_CAN_tick 1 // 20 millisecond
|
|
||||||
#define METRO_OW_read_tick 20 // 20 millisecond
|
|
||||||
#define METRO_OW_search_tick 10000 // 1000 millisecond
|
|
||||||
// CAN bus
|
|
||||||
#define CAN_speed 125000
|
|
||||||
#define CAN_RS_PIN 2
|
|
||||||
// OneWire
|
|
||||||
#define OW_pin 14
|
|
||||||
|
|
||||||
#define TEST_ADDR "125B275000000026"
|
|
||||||
|
|
||||||
#define DS2406_FAMILY 0x12
|
|
||||||
#define DS2406_WRITE_STATUS 0x55
|
|
||||||
#define DS2406_READ_STATUS 0xaa
|
|
||||||
#define DS2406_CHANNEL_ACCESS 0xf5
|
|
||||||
#define DS2406_CHANNEL_CONTROL1 0x4c // 01001100 - Read Both Pins
|
|
||||||
#define DS2406_CHANNEL_CONTROL2 0xff // for future dev
|
|
||||||
#define SKIP_ROM 0xCC
|
|
||||||
#define PIO_A 0x20
|
|
||||||
#define PIO_B 0x40
|
|
||||||
|
|
||||||
#define DS2406_BUF_LEN 10
|
|
||||||
// Definitions
|
|
||||||
static OW_switch_t switches[N_SWITCHES];
|
|
||||||
static event_t events[N_EVENTS];
|
|
||||||
|
|
||||||
|
|
||||||
// Initialisation
|
|
||||||
// Misc
|
|
||||||
#if DEBUG
|
|
||||||
#define DEBUG_PRINT(a) Serial.print(a)
|
|
||||||
#define DEBUG_WRITE(a) Serial.write(a)
|
|
||||||
#else
|
|
||||||
#define DEBUG_PRINT(a)
|
|
||||||
#define DEBUG_WRITE(a)
|
|
||||||
#endif /* DEBUG */
|
|
||||||
|
|
||||||
int led = LED;
|
|
||||||
// Metro
|
|
||||||
Metro METRO_CAN = Metro(METRO_CAN_tick);
|
|
||||||
Metro METRO_OW_read = Metro(METRO_OW_read_tick);
|
|
||||||
Metro METRO_OW_search = Metro(METRO_OW_search_tick);
|
|
||||||
// CAN bus
|
|
||||||
FlexCAN CANbus(CAN_speed);
|
|
||||||
// OneWire
|
|
||||||
uint8_t addr[8];
|
|
||||||
uint8_t buffer[DS2406_BUF_LEN];
|
|
||||||
uint8_t readout,trig_event,event_idx,tmp;
|
|
||||||
OneWire OW_1(OW_pin);
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
|
|
||||||
static CAN_message_t txmsg,rxmsg;
|
|
||||||
static uint8_t hex[17] = "0123456789abcdef";
|
|
||||||
|
|
||||||
int txCount,rxCount;
|
|
||||||
unsigned int txTimer,rxTimer;
|
|
||||||
|
|
||||||
|
|
||||||
// Functions -------------------------------------------------------
|
|
||||||
void PrintBytes(uint8_t* addr, uint8_t count, bool newline=0) {
|
|
||||||
for (uint8_t i = 0; i < count; i++) {
|
|
||||||
Serial.print(addr[i]>>4, HEX);
|
|
||||||
Serial.print(addr[i]&0x0f, HEX);
|
|
||||||
}
|
|
||||||
if (newline)
|
|
||||||
Serial.println();
|
|
||||||
}
|
|
||||||
void DEBUG_Bytes(uint8_t* addr, uint8_t count, bool newline=0) {
|
|
||||||
#if DEBUG
|
|
||||||
for (uint8_t i = 0; i < count; i++) {
|
|
||||||
Serial.print(addr[i]>>4, HEX);
|
|
||||||
Serial.print(addr[i]&0x0f, HEX);
|
|
||||||
}
|
|
||||||
if (newline)
|
|
||||||
Serial.println();
|
|
||||||
#endif
|
|
||||||
}
|
|
||||||
void print_OW_Device(uint8_t *addr) {
|
|
||||||
for(int i = 0; i < 8; i++) {
|
|
||||||
if(i != 0) {
|
|
||||||
Serial.print(":");
|
|
||||||
}
|
|
||||||
Serial.print(addr[i], HEX);
|
|
||||||
}
|
|
||||||
}
|
|
||||||
uint8_t read_DS2406(uint8_t* addr) {
|
|
||||||
// We're using a temporary switch object here only because we're
|
|
||||||
// discovering them dynamically. Depending on your app, you may
|
|
||||||
// already know the serial number of the device you intend to
|
|
||||||
// control and will use it there.
|
|
||||||
OW_1.reset();
|
|
||||||
OW_1.select(addr);
|
|
||||||
OW_1.write(DS2406_CHANNEL_ACCESS,1);
|
|
||||||
OW_1.write(DS2406_CHANNEL_CONTROL1,1);
|
|
||||||
OW_1.write(DS2406_CHANNEL_CONTROL2,1);
|
|
||||||
tmp = OW_1.read();
|
|
||||||
OW_1.reset();
|
|
||||||
#if DEBUG
|
|
||||||
PrintBytes(&tmp,1,1);
|
|
||||||
#endif /* DEBUG */
|
|
||||||
return tmp;
|
|
||||||
}
|
|
||||||
// -------------------------------------------------------------
|
|
||||||
void setup(void)
|
|
||||||
{
|
|
||||||
// Misc
|
|
||||||
switches[0].nick = 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;
|
|
||||||
|
|
||||||
events[0].id =0x01;
|
|
||||||
events[0].telegram.id = 0x0102DEAD;
|
|
||||||
events[0].telegram.len = 2;
|
|
||||||
events[0].telegram.buf[0] = 0xDE;
|
|
||||||
events[0].telegram.buf[1] = 0xAD;
|
|
||||||
events[1].id =0x02;
|
|
||||||
events[1].telegram.id = 0x0204BEEF;
|
|
||||||
events[1].telegram.len = 2;
|
|
||||||
events[1].telegram.buf[0] = 0xBE;
|
|
||||||
events[1].telegram.buf[1] = 0xEF;
|
|
||||||
|
|
||||||
//{ 0x02040608, 2, { 0xbe, 0xef }}};
|
|
||||||
|
|
||||||
Serial.begin(115200);
|
|
||||||
pinMode(led, OUTPUT);
|
|
||||||
digitalWrite(led, 1);
|
|
||||||
|
|
||||||
//CAN bus
|
|
||||||
pinMode(CAN_RS_PIN,OUTPUT);
|
|
||||||
digitalWrite(CAN_RS_PIN,0);
|
|
||||||
CANbus.begin();
|
|
||||||
txmsg.ext = 1;
|
|
||||||
txmsg.timeout = 100;
|
|
||||||
|
|
||||||
|
|
||||||
delay(100);
|
|
||||||
Serial.println(F("Hello Teensy 3.2 CANode awakes."));
|
|
||||||
METRO_CAN.reset();
|
|
||||||
METRO_OW_read.reset();
|
|
||||||
METRO_OW_search.reset();
|
|
||||||
}
|
|
||||||
|
|
||||||
|
|
||||||
// -------------------------------------------------------------
|
|
||||||
void loop(void)
|
|
||||||
{
|
|
||||||
// service software timers based on Metro tick
|
|
||||||
if ( METRO_OW_search.check() ) {
|
|
||||||
OW_1.reset_search();
|
|
||||||
while(OW_1.search(addr) == 1) {
|
|
||||||
if ( OneWire::crc8( addr, 7) != addr[7]) {
|
|
||||||
Serial.print("CRC is not valid!\n");
|
|
||||||
delay(100);
|
|
||||||
return;
|
|
||||||
}
|
|
||||||
Serial.print("Found a device: ");
|
|
||||||
print_OW_Device(addr);
|
|
||||||
Serial.println("");
|
|
||||||
}
|
|
||||||
}
|
|
||||||
if (METRO_OW_read.check() ) {
|
|
||||||
bool action[2];
|
|
||||||
readout = read_DS2406(switches[0].addr);
|
|
||||||
if (switches[0].state != readout) {
|
|
||||||
tmp = readout ^ switches[0].state;
|
|
||||||
switches[0].state = readout;
|
|
||||||
action[0] = tmp & 0x04;
|
|
||||||
action[1] = tmp & 0x08;
|
|
||||||
}
|
|
||||||
if (action[0]) {
|
|
||||||
Serial.print("pioA toggled");
|
|
||||||
digitalWrite(led, !digitalRead(led));
|
|
||||||
trig_event = switches[0].event_id[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];
|
|
||||||
event_idx = 0;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
if ( METRO_CAN.check() ) {
|
|
||||||
if ( txTimer ) {
|
|
||||||
--txTimer;
|
|
||||||
}
|
|
||||||
if ( rxTimer ) {
|
|
||||||
--rxTimer;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
if ( txmsg.len == 0 && trig_event != 0 ) {
|
|
||||||
if ( events[event_idx].id == trig_event ) {
|
|
||||||
txmsg.id = events[event_idx].telegram.id;
|
|
||||||
txmsg.len = events[event_idx].telegram.len;
|
|
||||||
for (uint i=0;i<txmsg.len;i++){
|
|
||||||
txmsg.buf[i] = events[event_idx].telegram.buf[i];
|
|
||||||
}
|
|
||||||
}
|
|
||||||
if ( events[event_idx].id == 0) { trig_event = 0; }
|
|
||||||
event_idx++;
|
|
||||||
}
|
|
||||||
// if not time-delayed, read CAN messages and print 1st byte
|
|
||||||
if ( !rxTimer ) {
|
|
||||||
while ( CANbus.read(rxmsg) ) {
|
|
||||||
//hexDump( sizeof(rxmsg), (uint8_t *)&rxmsg );
|
|
||||||
DEBUG_WRITE(rxmsg.buf[0]);
|
|
||||||
rxCount++;
|
|
||||||
}
|
|
||||||
}
|
|
||||||
|
|
||||||
// insert a time delay between transmissions
|
|
||||||
if ( !txTimer ) {
|
|
||||||
// if frames were received, print the count
|
|
||||||
if ( rxCount ) {
|
|
||||||
//#if DEBUG
|
|
||||||
Serial.write('=');
|
|
||||||
Serial.print(rxCount);
|
|
||||||
Serial.print(",Hello=");
|
|
||||||
Serial.print(rxmsg.id,HEX);
|
|
||||||
//#endif
|
|
||||||
rxCount = 0;
|
|
||||||
}
|
|
||||||
txTimer = 100;//milliseconds
|
|
||||||
//txmsg.len = 8;
|
|
||||||
//txmsg.id = 0x222;
|
|
||||||
//for( int idx=0; idx<8; ++idx ) {
|
|
||||||
// txmsg.buf[idx] = '0'+idx;
|
|
||||||
//}
|
|
||||||
// send 6 at a time to force tx buffering
|
|
||||||
// txCount = 16;
|
|
||||||
//digitalWrite(led, 1);
|
|
||||||
// Serial.println(".");
|
|
||||||
//while ( txCount-- ) {
|
|
||||||
if (txmsg.len != 0){
|
|
||||||
Serial.print("Sending to CAN");
|
|
||||||
Serial.print(txmsg.id,HEX);
|
|
||||||
CANbus.write(txmsg);
|
|
||||||
txmsg.buf[0]++;
|
|
||||||
//}
|
|
||||||
txmsg.len = 0;
|
|
||||||
}
|
|
||||||
// digitalWrite(led, 0);
|
|
||||||
// time delay to force some rx data queue use
|
|
||||||
rxTimer = 3;//milliseconds
|
|
||||||
}
|
|
||||||
|
|
||||||
}
|
|
||||||
19
src/CANode.h
19
src/CANode.h
@ -1,19 +0,0 @@
|
|||||||
#include <Arduino.h>
|
|
||||||
|
|
||||||
typedef struct CAN_telegram_t {
|
|
||||||
uint32_t id;
|
|
||||||
uint8_t len;
|
|
||||||
uint8_t buf[8];
|
|
||||||
} CAN_telegram_t;
|
|
||||||
|
|
||||||
typedef struct OW_switch_t {
|
|
||||||
uint8_t nick;
|
|
||||||
uint8_t addr[8];
|
|
||||||
uint8_t state;
|
|
||||||
uint8_t event_id[2];
|
|
||||||
} OW_switch_t;
|
|
||||||
|
|
||||||
typedef struct event_t {
|
|
||||||
uint8_t id;
|
|
||||||
CAN_telegram_t telegram;
|
|
||||||
} event_t;
|
|
||||||
Loading…
x
Reference in New Issue
Block a user