Subversion Repositories HomeAutomation

/* ----------------------------------------------------------------------------

 * Inclusions

 * --------------------------------------------------------------------------*/

#include "sns_Serial.h"

/* ----------------------------------------------------------------------------

 * Definitions

 * --------------------------------------------------------------------------*/

#define sns_Serial_DEBUG 0

#ifndef min

#define min(_a,_b)      ((_a)<(_b) ? (_a) : (_b))

#endif

#ifndef max

#define max(_a,_b)      ((_a)>(_b) ? (_a) : (_b))

#endif

#ifndef lim

#define lim(_a,_minval,_maxval)     (max(min((_a),(_maxval)),(_minval)))

#endif

typedef enum {

    PARITY_NONE = 0,

    PARITY_EVEN = 1,

    PARITY_ODD = 2,

} parityMode_t;

/* ----------------------------------------------------------------------------

 * Variables

 * --------------------------------------------------------------------------*/

static uint32_t baudRate = 9600;

static uint16_t format = CAN_MODULE_ENUM_SERIAL_SERIALCONFIG_PHYSICALFORMAT_RS232;

static uint8_t databits = 8;

static uint8_t stopbits = 1;

static parityMode_t parityMode = PARITY_NONE;

static uint8_t dataTimeout = 255;

static uint8_t packetLength = 0;

static struct __attribute__ ((packed)) {

    uint8_t prefixLength:2;

    uint8_t suffixLength:2;

    uint8_t prefixPattern[3];

    uint8_t suffixPattern[3];

} filter;

static StdCan_Msg_t msg;

#if sns_Serial_USEEEPROM==1

#include "sns_Serial_eeprom.h"

struct eeprom_sns_Serial EEMEM eeprom_sns_Serial =

{

    {

        9600,   // baudRate

        CAN_MODULE_ENUM_SERIAL_SERIALCONFIG_PHYSICALFORMAT_LOOPBACK,    // format

        8,      // databits

        1,      // stopbits

        PARITY_NONE,    // parityMode

        255,    // dataTimeout

        8,      // packetLength

        0,      // prefixLength

        0,      // suffixLength

        {0,0,0},    // prefixPattern

        {0,0,0},    // suffixPattern

    },

};

#endif

/* ----------------------------------------------------------------------------

 * Internal Functions

 * --------------------------------------------------------------------------*/

static uint16_t getTimeoutValue(void)

{

    // configurations 0-250 translate directly to milliseconds (0 means DIRECT)

    if (dataTimeout>=0 && dataTimeout<=250) {

        return dataTimeout;    

    }

    // configurations 251..254 are baudrate-dependent

    else if (dataTimeout>=251 && dataTimeout<=254) {

        return (uint16_t)(baudRate/(uint32_t)1000UL*((uint32_t)dataTimeout-250UL));

    }

    // configuration 255 means use the compiled default value

    else {

        return sns_Serial_FORCE_SEND_TIME_MS;

    }

}

/* ----------------------------------------------------------------------------

 * Function Implementations

 * --------------------------------------------------------------------------*/

uint8_t sns_Serial_setSettings(void)

{

    uint8_t returnval = 1;

    if (format == CAN_MODULE_ENUM_SERIAL_SERIALCONFIG_PHYSICALFORMAT_RS232)

    {

#if sns_Serial_DEBUG==1

        printf("RS232\n");

#endif

        gpio_clr_pin(sns_Serial_485_CONNECT);   // disable RS485_CONNECT

        gpio_clr_pin(sns_Serial_TERM_EN);       // disable termination

        gpio_clr_pin(sns_Serial_485_232);       // RS232 mode

        gpio_set_pin(sns_Serial_RXEN);          // enable RX

        gpio_set_pin(sns_Serial_ON);            // enable charge pump

    }

    else if (format == CAN_MODULE_ENUM_SERIAL_SERIALCONFIG_PHYSICALFORMAT_RS485FULLDUPLEX)

    {

#if sns_Serial_DEBUG==1

        printf("RS485FD\n");

#endif

        gpio_clr_pin(sns_Serial_485_CONNECT);   // disable RS485_CONNECT

        gpio_clr_pin(sns_Serial_TERM_EN);       // disable termination

        gpio_set_pin(sns_Serial_485_232);       // RS485 mode

        gpio_set_pin(sns_Serial_RXEN);          // enable RX

        gpio_set_pin(sns_Serial_TXEN);          // enable TX

        gpio_set_pin(sns_Serial_ON);            // enable charge pump

    }

    else if (format == CAN_MODULE_ENUM_SERIAL_SERIALCONFIG_PHYSICALFORMAT_RS485HALFDUPLEX)

    {

#if sns_Serial_DEBUG==1

        printf("RS485HD\n");

#endif

        gpio_set_pin(sns_Serial_485_CONNECT);   // enable RS485_CONNECT

        gpio_clr_pin(sns_Serial_TERM_EN);       // disable termination

        gpio_set_pin(sns_Serial_485_232);       // RS485 mode

        gpio_set_pin(sns_Serial_RXEN);          // enable RX

    /* TODO shoud the TX really be enabled in half duplex? */

        gpio_set_pin(sns_Serial_TXEN);          // enable TX

        gpio_set_pin(sns_Serial_ON);            // enable charge pump

    }

    else if (format == CAN_MODULE_ENUM_SERIAL_SERIALCONFIG_PHYSICALFORMAT_RS485HALFDUPLEXWITHTERMINATION)

    {

#if sns_Serial_DEBUG==1

        printf("485HDT\n");

#endif

        gpio_set_pin(sns_Serial_485_CONNECT);   // enable RS485_CONNECT

        gpio_set_pin(sns_Serial_TERM_EN);       // enable termination

        gpio_set_pin(sns_Serial_485_232);       // RS485 mode

    /* TODO shoud the TX really be enabled in half duplex? */

        gpio_set_pin(sns_Serial_RXEN);          // enable RX

        gpio_set_pin(sns_Serial_TXEN);          // enable TX

        gpio_set_pin(sns_Serial_ON);            // enable charge pump

    }

    else if (format == CAN_MODULE_ENUM_SERIAL_SERIALCONFIG_PHYSICALFORMAT_LOOPBACK)

    {

#if sns_Serial_DEBUG==1

        printf("LPMODE\n");

#endif

        gpio_clr_pin(sns_Serial_485_CONNECT);   // disable RS485_CONNECT

        gpio_clr_pin(sns_Serial_TERM_EN);       // disable termination

        gpio_set_pin(sns_Serial_485_232);       // RS232 mode

        gpio_set_pin(sns_Serial_RXEN);          // enable RX

        gpio_set_pin(sns_Serial_TXEN);          // enable TX

        gpio_clr_pin(sns_Serial_ON);            // disable charge pump (i.e. enable loopback)

    }

    else

    {

        //invalid format

#if sns_Serial_DEBUG==1

        printf("ERROR!\n");

#endif

        //return 0, not successful

        returnval = 0;

    }

    return returnval;

}

void sns_Serial_Init()

{

    /* Init filter in case eeprom not correct */

    filter.prefixLength = 0;

    filter.suffixLength = 0;

    filter.prefixPattern[0] = 0;

    filter.prefixPattern[1] = 0;

    filter.prefixPattern[2] = 0;

    filter.suffixPattern[0] = 0;

    filter.suffixPattern[1] = 0;

    filter.suffixPattern[2] = 0;

#if sns_Serial_USEEEPROM==1

    if (EEDATA_OK) {

    //if (0) {

#if ((__AVR_LIBC_MAJOR__ == 1  && __AVR_LIBC_MINOR__ == 6 && __AVR_LIBC_REVISION__ >=2)||(__AVR_LIBC_MAJOR__ == 1  && __AVR_LIBC_MINOR__ > 6)||__AVR_LIBC_MAJOR__ > 1)

        baudRate = eeprom_read_dword(EEDATA32.baudRate);

#else

#warning This version of AVR-libc does not have support for eeprom read dword

#endif

        format = eeprom_read_word(EEDATA16.format);

        databits = eeprom_read_byte(EEDATA.databits);

        stopbits = eeprom_read_byte(EEDATA.stopbits);

        parityMode = eeprom_read_byte(EEDATA.parityMode);

        dataTimeout = eeprom_read_byte(EEDATA.dataTimeout);

        packetLength = eeprom_read_byte(EEDATA.packetLength);

        filter.prefixLength = lim(eeprom_read_byte(EEDATA.prefixLength), 0, 3);

        filter.suffixLength = lim(eeprom_read_byte(EEDATA.suffixLength), 0, 3);

        filter.prefixPattern[0] = eeprom_read_byte(EEDATA.prefixPattern[0]);

        filter.prefixPattern[1] = eeprom_read_byte(EEDATA.prefixPattern[1]);

        filter.prefixPattern[2] = eeprom_read_byte(EEDATA.prefixPattern[2]);

        filter.suffixPattern[0] = eeprom_read_byte(EEDATA.suffixPattern[0]);

        filter.suffixPattern[1] = eeprom_read_byte(EEDATA.suffixPattern[1]);

        filter.suffixPattern[2] = eeprom_read_byte(EEDATA.suffixPattern[2]);

    }

    else {

        //The CRC of the EEPROM is not correct, store default values and update CRC

#if ((__AVR_LIBC_MAJOR__ == 1  && __AVR_LIBC_MINOR__ == 6 && __AVR_LIBC_REVISION__ >=2)||(__AVR_LIBC_MAJOR__ == 1  && __AVR_LIBC_MINOR__ > 6)||__AVR_LIBC_MAJOR__ > 1)

        eeprom_write_dword_crc(EEDATA32.baudRate, 9600, WITHOUT_CRC);

#else

#warning This version of AVR-libc does not have support for eeprom write dword

#endif

        eeprom_write_word_crc(EEDATA16.format, CAN_MODULE_ENUM_SERIAL_SERIALCONFIG_PHYSICALFORMAT_LOOPBACK, WITHOUT_CRC);

        eeprom_write_byte_crc(EEDATA.databits, 8, WITHOUT_CRC);

        eeprom_write_byte_crc(EEDATA.stopbits, 1, WITHOUT_CRC);

        eeprom_write_byte_crc(EEDATA.parityMode, PARITY_NONE, WITHOUT_CRC);

        eeprom_write_byte_crc(EEDATA.dataTimeout, 255, WITHOUT_CRC);

        eeprom_write_byte_crc(EEDATA.packetLength, 8, WITHOUT_CRC);

        eeprom_write_byte_crc(EEDATA.prefixLength, 0, WITHOUT_CRC);

        eeprom_write_byte_crc(EEDATA.suffixLength, 0, WITHOUT_CRC);

        eeprom_write_byte_crc(EEDATA.prefixPattern[0], 0, WITHOUT_CRC);

        eeprom_write_byte_crc(EEDATA.prefixPattern[1], 0, WITHOUT_CRC);

        eeprom_write_byte_crc(EEDATA.prefixPattern[2], 0, WITHOUT_CRC);

        eeprom_write_byte_crc(EEDATA.suffixPattern[0], 0, WITHOUT_CRC);

        eeprom_write_byte_crc(EEDATA.suffixPattern[1], 0, WITHOUT_CRC);

        eeprom_write_byte_crc(EEDATA.suffixPattern[2], 0, WITHOUT_CRC);

        EEDATA_UPDATE_CRC;

    }

#endif

    uart_setDatabits(databits);

    uart_setStopbits(stopbits);

    uart_setParity(parityMode!=PARITY_NONE, parityMode==PARITY_ODD);

    uart_init(UART_BAUD_SELECT(baudRate, F_CPU));

    // configure control pins to outputs

    gpio_set_out(sns_Serial_RXEN);

    gpio_set_out(sns_Serial_TXEN);

    gpio_set_out(sns_Serial_ON);

    gpio_set_out(sns_Serial_485_232);

    gpio_set_out(sns_Serial_TERM_EN);

    gpio_set_out(sns_Serial_485_CONNECT);

    sns_Serial_setSettings();

#if sns_Serial_DEBUG==1

    printf("Serial started!\n");

#endif

    msg.Length = 0; // no data so far

    //gpio_set_pin(sns_Serial_TXEN);            // enable TX

    //uart_putc('7');

}

void sns_Serial_Process(void)

{

    StdCan_Set_class(msg.Header, CAN_MODULE_CLASS_SNS);

    StdCan_Set_direction(msg.Header, DIRECTIONFLAG_TO_OWNER);

    msg.Header.ModuleType = CAN_MODULE_TYPE_SNS_SERIAL;

    msg.Header.ModuleId = sns_Serial_ID;

    msg.Header.Command = CAN_MODULE_CMD_SERIAL_SERIALDATA;

    unsigned char status;

    do

    {

        // ask uart driver for more data

        unsigned int data = uart_getc();

        // character is contained in LSB

        unsigned char c = (unsigned char)(data & 0x00FF);

        // status is contained in MSB

        status = (unsigned char)((data & 0xFF00) >> 8);

        // status == 0 means we just received a new char

        if (status == 0)

        {

#if sns_Serial_DEBUG==1

            printf("RX\n");

#endif

            // insert it into the message

            msg.Data[(uint8_t)msg.Length] = c;

            msg.Length++;

            uint16_t timeout;

            if ((timeout = getTimeoutValue()) != 0) {

                Timer_SetTimeout(sns_Serial_FORCE_SEND_TIMER, timeout , TimerTypeOneShot, 0);

            }

        }

    // keep going until max data length reached, or until uart RXBUF is empty

    } while (status == 0 && msg.Length < packetLength);

    // check if force send or send-frame full

    if ((Timer_Expired(sns_Serial_FORCE_SEND_TIMER) && msg.Length>0) || msg.Length==packetLength || (getTimeoutValue()==0 && msg.Length>0))

    {

        // transmit this chunk of data (max 8 chars)

        while(StdCan_Put(&msg) != StdCan_Ret_OK);

        msg.Length = 0; // no data so far

    }

}

void sns_Serial_HandleMessage(StdCan_Msg_t *rxMsg)

{

    if (    StdCan_Ret_class(rxMsg->Header) == CAN_MODULE_CLASS_SNS &&

        StdCan_Ret_direction(rxMsg->Header) == DIRECTIONFLAG_FROM_OWNER &&

        rxMsg->Header.ModuleType == CAN_MODULE_TYPE_SNS_SERIAL &&

        rxMsg->Header.ModuleId == sns_Serial_ID)

    {

        switch (rxMsg->Header.Command)

        {

            case CAN_MODULE_CMD_SERIAL_SERIALDATA:

#if sns_Serial_DEBUG==1

                printf("TX\n");

#endif

                gpio_set_pin(sns_Serial_TXEN);          // enable TX

                for (uint8_t i=0; i<rxMsg->Length; i++)

                {

                    uart_putc(rxMsg->Data[i]);

                }

                /* TODO Cannot disable TX yet, the data has only been placed in buffer but not sent */

//              gpio_clr_pin(sns_Serial_TXEN);          // disable TX

                break;

            case CAN_MODULE_CMD_SERIAL_SERIALCONFIG:

                baudRate = 10 * (((uint32_t)rxMsg->Data[1] << 0) | ((uint32_t)rxMsg->Data[0] << 8));

                format = (uint16_t)rxMsg->Data[2];

                databits = lim(rxMsg->Data[3], 5, 9);

                stopbits = lim(rxMsg->Data[4], 1, 2);

                parityMode = lim(rxMsg->Data[5], 0, 2);

                uart_setDatabits(databits);

                uart_setStopbits(stopbits);

                uart_setParity(parityMode!=PARITY_NONE, parityMode==PARITY_ODD);

                uart_init(UART_BAUD_SELECT(baudRate, F_CPU));

                uint8_t returnval = sns_Serial_setSettings();

                if (returnval)

                {

                // update EEPROM data

#if sns_Serial_USEEEPROM==1

#if ((__AVR_LIBC_MAJOR__ == 1  && __AVR_LIBC_MINOR__ == 6 && __AVR_LIBC_REVISION__ >=2)||(__AVR_LIBC_MAJOR__ == 1  && __AVR_LIBC_MINOR__ > 6)||__AVR_LIBC_MAJOR__ > 1)

                eeprom_write_dword_crc(EEDATA32.baudRate, baudRate, WITHOUT_CRC);

#else

#warning This version of AVR-libc does not have support for eeprom read dword

#endif

                eeprom_write_word_crc(EEDATA16.format, format, WITHOUT_CRC);

                eeprom_write_byte_crc(EEDATA.databits, databits, WITHOUT_CRC);

                eeprom_write_byte_crc(EEDATA.stopbits, stopbits, WITHOUT_CRC);

                eeprom_write_byte_crc(EEDATA.parityMode, parityMode, WITHOUT_CRC);

                EEDATA_UPDATE_CRC;

#endif

                }

                break;

            case CAN_MODULE_CMD_SERIAL_SERIALFILTER:

                dataTimeout = rxMsg->Data[0];

                filter.prefixLength = ((rxMsg->Data[1] & 0x0F) >> 0);

                filter.suffixLength = ((rxMsg->Data[1] & 0x30) >> 4);

                packetLength = ((rxMsg->Data[1] & 0xC0) >> 6);

                filter.prefixPattern[2] = rxMsg->Data[2];

                filter.prefixPattern[1] = rxMsg->Data[3];

                filter.prefixPattern[0] = rxMsg->Data[4];

                filter.suffixPattern[2] = rxMsg->Data[5];

                filter.suffixPattern[1] = rxMsg->Data[6];

                filter.suffixPattern[0] = rxMsg->Data[7];

                // update EEPROM data

                eeprom_write_byte_crc(EEDATA.dataTimeout, dataTimeout, WITHOUT_CRC);

                eeprom_write_byte_crc(EEDATA.packetLength, packetLength, WITHOUT_CRC);

                eeprom_write_byte_crc(EEDATA.prefixLength, filter.prefixLength, WITHOUT_CRC);

                eeprom_write_byte_crc(EEDATA.suffixLength, filter.suffixLength, WITHOUT_CRC);

                eeprom_write_byte_crc(EEDATA.prefixPattern[0], filter.prefixPattern[0], WITHOUT_CRC);

                eeprom_write_byte_crc(EEDATA.prefixPattern[1], filter.prefixPattern[1], WITHOUT_CRC);

                eeprom_write_byte_crc(EEDATA.prefixPattern[2], filter.prefixPattern[2], WITHOUT_CRC);

                eeprom_write_byte_crc(EEDATA.suffixPattern[0], filter.suffixPattern[0], WITHOUT_CRC);

                eeprom_write_byte_crc(EEDATA.suffixPattern[1], filter.suffixPattern[1], WITHOUT_CRC);

                eeprom_write_byte_crc(EEDATA.suffixPattern[2], filter.suffixPattern[2], WITHOUT_CRC);

                EEDATA_UPDATE_CRC;

                break;

        }

    }

}

void sns_Serial_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_SERIAL;

    txMsg.Header.ModuleId = sns_Serial_ID;

    txMsg.Header.Command = CAN_MODULE_CMD_GLOBAL_LIST;

    txMsg.Length = 6;

    uint32_t HwId=BIOS_GetHwId();

    txMsg.Data[0] = HwId&0xff;

    txMsg.Data[1] = (HwId>>8)&0xff;

    txMsg.Data[2] = (HwId>>16)&0xff;

    txMsg.Data[3] = (HwId>>24)&0xff;

    txMsg.Data[4] = NUMBER_OF_MODULES;

    txMsg.Data[5] = ModuleSequenceNumber;

    while (StdCan_Put(&txMsg) != StdCan_Ret_OK);

}