#include <nuvoton/functions.h>
#include <nuvoton/N76E003.h>
#include <nuvoton/Common.h>
#include <nuvoton/SFR_Macro.h>
#include <string.h>
#include "MySensors.h"

#define RS485_DIR P14

#define IN1 P05
#define IN2 P15

#define RELAY1 P13
#define RELAY2 P01

#define MAXCMD 64

unsigned char relay;

unsigned char crc;

void rs485_in(void) {
	RS485_DIR = 0;
}

void rs485_out(void) {
	RS485_DIR = 1;
}

void receive(const MyMessage* mymsg)
{
	 uint8_t sensor;

	  // We only expect one type of message from controller. But we better check anyway.
	 if (mymsg->type == V_STATUS) {
	    sensor = mymsg->sensor;
	    if (sensor == 3)
	    	RELAY1 = (mymsg->data[0]=='1')?1:0;
	    if (sensor == 4)
	    	RELAY2 = (mymsg->data[0]=='1')?1:0;
	 }
}

void present_node(void) {
  present(NODE_SENSOR_ID, S_ARDUINO_NODE,"Nuvoton Relay Board");
  sendSketchInfo("Relay_Nuvoton", "1.1");
  present(1, S_DOOR, "IN1");
  present(2, S_DOOR, "IB2");
  present(3, S_BINARY, "Relay 1");
  present(4, S_BINARY, "Relay 2");
  registerNode();
  delay(20);
}

void uart_loop() {
	transportProcess();
}

void uart_init(UINT32 u32Baudrate) //T1M = 1, SMOD = 1
{
	P06_PushPull_Mode; 
	P07_Input_Mode;

	SCON = 0x50;  //UART0 Mode1,REN=1,TI=1
	TMOD |= 0x20; //Timer1 Mode1

	set_SMOD; //UART0 Double Rate Enable
	set_T1M;
	clr_BRCK; //Serial port 0 baud rate clock source = Timer1

#ifdef FOSC_160000
	TH1 = 256 - (1000000 / u32Baudrate + 1); /*16 MHz */
#endif
#ifdef FOSC_166000
	TH1 = 256 - (1037500 / u32Baudrate); /*16.6 MHz */
#endif
	set_TR1;
	set_TI; //For printf function must setting TI = 1
}

int main()
{
	uart_init(9600);

	RS485_DIR = 0;
	P13_PushPull_Mode;

	/* Relays */
        RELAY1 = 0;
        RELAY2 = 0;

        P01_PushPull_Mode;
        P13_PushPull_Mode;

        /* Inputs */
        P05_Input_Mode;
        P15_Input_Mode;

	transportInitialise();

	while (1)
	{
		uart_loop();
	}
}