#include "moacon500.h"
 
static u8 MDcoil[100];
static u16 MDregister[100];
 
//
// 모드버스 어드레스를 가지고 비트의 상태를 읽어오는 함수 
// a = coil(9); // 이렇게 하면 00009 비트 어드레스위치를 찾아서 해당 비트를 읽어온다.
 
u8 MDbitDecode[8] = {1,2,4,8,16,32,64,128};
 
u8 coil(u16 MDBSadr)
{
    MDBSadr--;
    if (MDcoil[MDBSadr>>3] & MDbitDecode[MDBSadr & 7]) return 1;
    return 0;
}
 
//
// 모드버스 어드레스로 비트의 상태를 변경
// coilSet(9,0); // 00009어드레스를 0으로 만든다.
// coilSet(9,1); // 00009어드레스를 1로 만든다. 
//
 
void coilSet(u16 MDBSadr, u8 MDBSdata)
{
    u16 arrayindex;
    MDBSadr--;
    arrayindex = MDBSadr>>3; // 배열에서의 위치 
    if (MDBSdata==0) {
        MDcoil[arrayindex] &= ~MDbitDecode[MDBSadr & 7];
        }
    else {
        MDcoil[arrayindex] |= MDbitDecode[MDBSadr & 7];
        }
}
 
void cmain(void)
{
   openCom(0,115200, C8N1);
	startModbusRtu(0,1,MDregister, MDcoil);
	clcdI2cInit(0);
	clcdPower(1);
	delay(100);
	portInit(3,0);
	for(;;) {
		MDregister[0]++;  // 증가하는것을 확인하기 위해서
		MDcoil[0]++;      // 코일 1~8까지 순차증가
 
		if (coil(17) != 0) portOn(30);
		else portOff(30);
		if (portIn(0)==0) coilSet(18,0);
		else coilSet(18,1);
	   delay(1);
		}
}