#include "sns_input.h"
uint8_t pinStatus[8];
#define HIGH 1
#define LOW 2
#define NOCHANGE 0
void sns_input_pcint_callback(uint8_t id, uint8_t status)
{
#ifdef sns_input_CH0
if (id == sns_input_PCINT_CH0) {
if (0 != status) {
pinStatus[0] = HIGH;
} else {
pinStatus[0] = LOW;
}
}
#endif
#ifdef sns_input_CH1
if (id == sns_input_PCINT_CH1) {
if (0 != status) {
pinStatus[1] = HIGH;
} else {
pinStatus[1] = LOW;
}
}
#endif
#ifdef sns_input_CH2
if (id == sns_input_PCINT_CH2) {
if (0 != status) {
pinStatus[2] = HIGH;
} else {
pinStatus[2] = LOW;
}
}
#endif
#ifdef sns_input_CH3
if (id == sns_input_PCINT_CH3) {
if (0 != status) {
pinStatus[3] = HIGH;
} else {
pinStatus[3] = LOW;
}
}
#endif
#ifdef sns_input_CH4
if (id == sns_input_PCINT_CH4) {
if (0 != status) {
pinStatus[4] = HIGH;
} else {
pinStatus[4] = LOW;
}
}
#endif
#ifdef sns_input_CH5
if (id == sns_input_PCINT_CH5) {
if (0 != status) {
pinStatus[5] = HIGH;
} else {
pinStatus[5] = LOW;
}
}
#endif
#ifdef sns_input_CH6
if (id == sns_input_PCINT_CH6) {
if (0 != status) {
pinStatus[6] = HIGH;
} else {
pinStatus[6] = LOW;
}
}
#endif
#ifdef sns_input_CH7
if (id == sns_input_PCINT_CH7) {
if (0 != status) {
pinStatus[7] = HIGH;
} else {
pinStatus[7] = LOW;
}
}
#endif
}
void sns_input_Init(void)
{
pinStatus[0] = NOCHANGE;
pinStatus[1] = NOCHANGE;
pinStatus[2] = NOCHANGE;
pinStatus[3] = NOCHANGE;
pinStatus[4] = NOCHANGE;
pinStatus[5] = NOCHANGE;
pinStatus[6] = NOCHANGE;
pinStatus[7] = NOCHANGE;
uint8_t index = 0;
#ifdef sns_input_CH0
#if (sns_input_CH0_pullup == 1)
gpio_set_pullup(sns_input_CH0);
#else
gpio_clr_pullup(sns_input_CH0);
#endif
gpio_set_in(sns_input_CH0);
Pcint_SetCallbackPin(sns_input_PCINT_CH0, sns_input_CH0, &sns_input_pcint_callback);
index++;
#endif
#ifdef sns_input_CH1
#if (sns_input_CH1_pullup == 1)
gpio_set_pullup(sns_input_CH1);
#else
gpio_clr_pullup(sns_input_CH1);
#endif
gpio_set_in(sns_input_CH1);
Pcint_SetCallbackPin(sns_input_PCINT_CH1, sns_input_CH1, &sns_input_pcint_callback);
index++;
#endif
#ifdef sns_input_CH2
#if (sns_input_CH2_pullup == 1)
gpio_set_pullup(sns_input_CH2);
#else
gpio_clr_pullup(sns_input_CH2);
#endif
gpio_set_in(sns_input_CH2);
Pcint_SetCallbackPin(sns_input_PCINT_CH2, sns_input_CH2, &sns_input_pcint_callback);
index++;
#endif
#ifdef sns_input_CH3
#if (sns_input_CH3_pullup == 1)
gpio_set_pullup(sns_input_CH3);
#else
gpio_clr_pullup(sns_input_CH3);
#endif
gpio_set_in(sns_input_CH3);
Pcint_SetCallbackPin(sns_input_PCINT_CH3, sns_input_CH3, &sns_input_pcint_callback);
index++;
#endif
#ifdef sns_input_CH4
#if (sns_input_CH4_pullup == 1)
gpio_set_pullup(sns_input_CH4);
#else
gpio_clr_pullup(sns_input_CH4);
#endif
gpio_set_in(sns_input_CH4);
Pcint_SetCallbackPin(sns_input_PCINT_CH4, sns_input_CH4, &sns_input_pcint_callback);
index++;
#endif
#ifdef sns_input_CH5
#if (sns_input_CH5_pullup == 1)
gpio_set_pullup(sns_input_CH5);
#else
gpio_clr_pullup(sns_input_CH5);
#endif
gpio_set_in(sns_input_CH5);
Pcint_SetCallbackPin(sns_input_PCINT_CH5, sns_input_CH5, &sns_input_pcint_callback);
index++;
#endif
#ifdef sns_input_CH6
#if (sns_input_CH6_pullup == 1)
gpio_set_pullup(sns_input_CH6);
#else
gpio_clr_pullup(sns_input_CH6);
#endif
gpio_set_in(sns_input_CH6);
Pcint_SetCallbackPin(sns_input_PCINT_CH6, sns_input_CH6, &sns_input_pcint_callback);
index++;
#endif
#ifdef sns_input_CH7
#if (sns_input_CH7_pullup == 1)
gpio_set_pullup(sns_input_CH7);
#else
gpio_clr_pullup(sns_input_CH7);
#endif
gpio_set_in(sns_input_CH7);
Pcint_SetCallbackPin(sns_input_PCINT_CH7, sns_input_CH7, &sns_input_pcint_callback);
index++;
#endif
// to use PCINt lib, call this function: (the callback function look as a timer callback function)
// Pcint_SetCallbackPin(sns_input_PCINT, EXP_C , &sns_input_pcint_callback);
}
void sns_input_Process(void)
{
///TODO: IMPLEMENT DEBOUNCE
uint8_t index = 0;
for (index = 0; index < 8; index++) {
if (pinStatus[index]!= NOCHANGE) {
StdCan_Msg_t txMsg;
StdCan_Set_class(txMsg.Header, CAN_MODULE_CLASS_SNS);
StdCan_Set_direction(txMsg.Header, DIRECTIONFLAG_FROM_OWNER);
txMsg.Header.ModuleType = CAN_MODULE_TYPE_SNS_INPUT;
txMsg.Header.ModuleId = sns_input_ID;
txMsg.Header.Command = CAN_MODULE_CMD_PHYSICAL_PINSTATUS;
txMsg.Length = 2;
txMsg.Data[0] = index;
if (pinStatus[index] == HIGH) {
txMsg.Data[1] = CAN_MODULE_ENUM_PHYSICAL_PINSTATUS_STATUS_HIGH;
} else {
txMsg.Data[1] = CAN_MODULE_ENUM_PHYSICAL_PINSTATUS_STATUS_LOW;
}
while (StdCan_Put(&txMsg) != StdCan_Ret_OK);
}
}
}
void sns_input_HandleMessage(StdCan_Msg_t *rxMsg)
{
}
void sns_input_List(uint8_t ModuleSequenceNumber)
{
StdCan_Msg_t txMsg;
StdCan_Set_class(txMsg.Header, CAN_MODULE_CLASS_SNS);
StdCan_Set_direction(txMsg.Header, DIRECTIONFLAG_FROM_OWNER);
txMsg.Header.ModuleType = CAN_MODULE_TYPE_SNS_INPUT;
txMsg.Header.ModuleId = sns_input_ID;
txMsg.Header.Command = CAN_MODULE_CMD_GLOBAL_LIST;
txMsg.Length = 6;
txMsg.Data[0] = NODE_HW_ID_BYTE0;
txMsg.Data[1] = NODE_HW_ID_BYTE1;
txMsg.Data[2] = NODE_HW_ID_BYTE2;
txMsg.Data[3] = NODE_HW_ID_BYTE3;
txMsg.Data[4] = NUMBER_OF_MODULES;
txMsg.Data[5] = ModuleSequenceNumber;
while (StdCan_Put(&txMsg) != StdCan_Ret_OK);
}