WIP

Software/UPSoftware/UPSoftware.ino

@@ -0,0 +1,137 @@
+#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;
+
+}