/*
 * LCD_HD44780.c
 *
 * Created: 20.01.2018 12:51:11
 *  Author: Ulrich
 */ 

#include <avr/io.h>
#include <avr/interrupt.h>
#include <util/delay.h>

#include "lcd.h"
#include "i2c.h"
#include "modbus.h"

volatile uint16_t holdingRegisters[4];

void modbusGet(void) {
	if (modbusGetBusState() & (1<<ReceiveCompleted))
	{
        switch(rxbuffer[1]) {
            case fcReadHoldingRegisters:
            case fcPresetSingleRegister:
            case fcPresetMultipleRegisters:
                modbusExchangeRegisters(holdingRegisters,0,4);
                lcd_home();
                lcd_write("test %x", holdingRegisters[0]);
                break;
            default:
                modbusSendException(ecIllegalFunction);
                break;
		}
	}
}

int main(void)
{
	i2c_init();
	lcd_init();
	
	lcd_clear();

    sei();
    modbusSetAddress(1);
    modbusInit();

    TCCR0B|=(1<<CS01); //prescaler 8
	TIMSK0|=(1<<TOIE0);

	while(1){
        modbusGet();
	}
}

ISR(TIMER0_OVF_vect) { //this ISR is called 9765.625 times per second
	modbusTickTimer();
}