#include <SPI.h>
#include <Ethernet.h>

#include "Mudbus.h"

//#define DEBUG
static unsigned long time;
Mudbus Mb;
//Function codes
//Read coils (FC 1) 0x
//Read input discretes (FC 2) 1x
//Read multiple registers (FC 3) 4x
//Read input registers (FC 4) 3x
//Write coil (FC 5) 0x
//Write single register (FC 6) 4x
//Force multiple coils (FC 15) 0x
//Write multiple registers (FC 16) 4x
// bool C[MB_N_C_0x];
// bool I[MB_N_I_1x];
// int IR[MB_N_IR_3x];
// int R[MB_N_HR_4x];

//Port 502 (defined in Mudbus.h) MB_PORT

void setup()
{
uint8_t mac[] = {0x90, 0xA2, 0xDA, 0x00, 0x71, 0x17 };
uint8_t ip[] = {192, 168, 1, 177 };
uint8_t gateway[] = {192, 168, 1, 1 };
uint8_t subnet[] = {255, 255, 255, 0 };
Ethernet.begin(mac, ip, gateway, subnet);
//Avoid pins 4,10,11,12,13 when using ethernet shield

delay(5000); //Time to open the terminal

pinMode(0, INPUT);
pinMode(1, INPUT);
pinMode(2, INPUT);
pinMode(3, INPUT);
//pinMode(4, INPUT);
pinMode(5, INPUT);
pinMode(6, INPUT);
pinMode(7, INPUT);
pinMode(8, INPUT);
pinMode(9, INPUT);
//pinMode(10, INPUT);
//pinMode(11, INPUT);
//pinMode(12, INPUT);
//pinMode(13, INPUT);
pinMode(A0, INPUT);
pinMode(A1, INPUT);
pinMode(A2, INPUT);
pinMode(A3, INPUT);
pinMode(A4, INPUT);
pinMode(A5, INPUT);
digitalWrite(0, HIGH); //pull-up enabled
digitalWrite(1, HIGH); //pull-up enabled
digitalWrite(2, HIGH); //pull-up enabled
digitalWrite(3, HIGH); //pull-up enabled
//digitalWrite(4, HIGH); //pull-up enabled
digitalWrite(5, HIGH); //pull-up enabled
digitalWrite(6, HIGH); //pull-up enabled
digitalWrite(7, HIGH); //pull-up enabled
digitalWrite(8, HIGH); //pull-up enabled
digitalWrite(9, HIGH); //pull-up enabled
//digitalWrite(10, HIGH); //pull-up enabled
//digitalWrite(11, HIGH); //pull-up enabled
//digitalWrite(12, HIGH); //pull-up enabled
//digitalWrite(13, HIGH); //pull-up enabled
digitalWrite(A0, HIGH); //pull-up enabled
digitalWrite(A1, HIGH); //pull-up enabled
digitalWrite(A2, HIGH); //pull-up enabled
digitalWrite(A3, HIGH); //pull-up enabled
digitalWrite(A4, HIGH); //pull-up enabled
digitalWrite(A5, HIGH); //pull-up enabled
}

void loop()
{

word location;

Mb.Run();

Mb.I[0] = digitalRead(0);
Mb.I[1] = digitalRead(1);
Mb.I[2] = digitalRead(2);
Mb.I[3] = digitalRead(3);
//Mb.I[4] = digitalRead(4);
Mb.I[5] = digitalRead(5);
Mb.I[6] = digitalRead(6);
Mb.I[7] = digitalRead(7);
Mb.I[8] = digitalRead(8);
Mb.I[9] = digitalRead(9);
//Mb.I[10] = digitalRead(10);
//Mb.I[11] = digitalRead(11);
//Mb.I[12] = digitalRead(12);
//Mb.I[13] = digitalRead(13);
Mb.I[A0] = digitalRead(A0);
Mb.I[A1] = digitalRead(A1);
Mb.I[A2] = digitalRead(A2);
Mb.I[A3] = digitalRead(A3);
Mb.I[A4] = digitalRead(A4);
Mb.I[A5] = digitalRead(A5);





// ./modpoll -m tcp -t1 -0 -r 1 -c 6 192.168.1.177
}