138 lines
2.7 KiB
C++
138 lines
2.7 KiB
C++
#include <SPI.h>;
|
|
#include <mcp2515.h>;
|
|
|
|
struct can_frame _frame;
|
|
MCP2515 mcp2515(PIN_PA3);
|
|
|
|
typedef struct
|
|
{
|
|
int pin_id;
|
|
bool pin_state;
|
|
short pin_wait;
|
|
bool pin_send_wait;
|
|
bool is_input;
|
|
byte meyPinId;
|
|
|
|
PinState() {}
|
|
void Init(int pin_id, byte meyPinId)
|
|
{
|
|
this->pin_id = pin_id;
|
|
this->pin_state = true;
|
|
this->pin_wait = 0;
|
|
this->is_input = true;
|
|
this->meyPinId = meyPinId;
|
|
}
|
|
} PinState;
|
|
|
|
int PinCount = 8;
|
|
PinState PinPD2[8];
|
|
|
|
|
|
|
|
void setup() {
|
|
SPI.begin();
|
|
|
|
|
|
PinPD2[0] = PinState();
|
|
PinPD2[0].Init(PIN_PD2, (byte) 4);
|
|
|
|
PinPD2[1] = PinState();
|
|
PinPD2[1].Init(PIN_PC7, (byte) 1);
|
|
|
|
PinPD2[2] = PinState();
|
|
PinPD2[2].Init(PIN_PD1, (byte) 3);
|
|
|
|
PinPD2[3] = PinState();
|
|
PinPD2[3].Init(PIN_PD0, (byte) 2);
|
|
|
|
PinPD2[4] = PinState();
|
|
PinPD2[4].Init(PIN_PD6, (byte) 5);
|
|
|
|
PinPD2[5] = PinState();
|
|
PinPD2[5].Init(PIN_PD5, (byte) 6);
|
|
|
|
PinPD2[6] = PinState();
|
|
PinPD2[6].Init(PIN_PD4, (byte) 7);
|
|
|
|
PinPD2[7] = PinState();
|
|
PinPD2[7].Init(PIN_PD3, (byte) 8);
|
|
|
|
_PROTECTED_WRITE(CLKCTRL.MCLKCTRLA, CLKCTRL.MCLKCTRLA | 1 << 7);
|
|
mcp2515.reset();
|
|
mcp2515.setBitrate(CAN_500KBPS, MCP_8MHZ); //Sets CAN at speed 500KBPS and Clock 8MHz
|
|
mcp2515.setNormalMode();
|
|
|
|
for (int i = 0; i <= PinCount - 1; i++)
|
|
{
|
|
pinMode(PinPD2[i].pin_id, INPUT_PULLUP);
|
|
}
|
|
}
|
|
|
|
|
|
void loop()
|
|
{
|
|
for (int i = 0; i <= PinCount - 1; i++)
|
|
{
|
|
if (CheckPinStatus(&PinPD2[i]))
|
|
SendCanPackage(&PinPD2[i]);
|
|
}
|
|
}
|
|
|
|
void SendCanPackage(PinState *state)
|
|
{
|
|
_frame.can_id = 0x001;
|
|
_frame.can_dlc = 4;
|
|
_frame.data[0] = state->meyPinId;
|
|
_frame.data[1] = state->pin_state;
|
|
_frame.data[2] = 0x00;
|
|
_frame.data[3] = 0x00;
|
|
mcp2515.sendMessage(&_frame);
|
|
}
|
|
|
|
bool ReadPin(PinState *state)
|
|
{
|
|
if (state->pin_id == PIN_PD2)
|
|
return digitalReadFast(PIN_PD2);
|
|
else if (state->pin_id == PIN_PC7)
|
|
return digitalReadFast(PIN_PC7);
|
|
else if (state->pin_id == PIN_PD1)
|
|
return digitalReadFast(PIN_PD1);
|
|
else if (state->pin_id == PIN_PD0)
|
|
return digitalReadFast(PIN_PD0);
|
|
else if (state->pin_id == PIN_PD6)
|
|
return digitalReadFast(PIN_PD6);
|
|
else if (state->pin_id == PIN_PD5)
|
|
return digitalReadFast(PIN_PD5);
|
|
else if (state->pin_id == PIN_PD4)
|
|
return digitalReadFast(PIN_PD4);
|
|
else if (state->pin_id == PIN_PD3)
|
|
return digitalReadFast(PIN_PD3);
|
|
else
|
|
return digitalRead(state->pin_id);
|
|
|
|
}
|
|
|
|
bool CheckPinStatus(PinState *state)
|
|
{
|
|
if (!state->is_input)
|
|
return false;
|
|
|
|
bool newValue = ReadPin(state);
|
|
|
|
|
|
if (newValue != state->pin_state)
|
|
{
|
|
delay(10);
|
|
newValue = ReadPin(state);
|
|
if (newValue != state->pin_state)
|
|
{
|
|
state->pin_state = newValue;
|
|
state->pin_wait = 2048; // block this pin for 16 loops (debouncer)
|
|
state->pin_send_wait = true;
|
|
return true;
|
|
}
|
|
}
|
|
return false;
|
|
|
|
}
|