/*
MBTS_GSM.c: Modbus TCP Slave via GPRS

Compiler: BC++ 3.1, 
          Turbo C++ 1.01(3.01)
          
Compile mode: large

Project: MBTS_GSM.C
         lib\G4500.lib
         lib\WServer.lib
		 lib\os7_com.lib
         lib\MBTCP.lb
          
Hardware: G-4500-2G		  
		  
[Feb 24, 2015] by William                                             
*/

#include "lib\G4500.h"
#include "lib\WServer.h"
#include "lib\os7_com.h"
#include "lib\MBTCP.h"

Server_Info MyServer;
_GPRS_DATA GPRSData;

unsigned char Memory_DO[1024] = {0};
unsigned char Memory_DI[1024] = {0};
unsigned short Memory_AO[1024] = {0};
unsigned short Memory_AI[1024] = {0};

int DISize = 1024;
int DOSize = 1024;
int AISize = 1024;
int AOSize = 1024;

const int ModbusID = 1;

unsigned char SendData[1460] = {0};
int SendLen;

int ModbusTCP_Init(void)
{
    char LibVer[30] = {0};
    int i;

    MBT_GetVer(LibVer);  //Get modbus TCP lib version
    Print("Modbus TCP lib:%s\r\n",LibVer);

    MBT_Init(&Memory_DI,&Memory_DO,&Memory_AI,&Memory_AO);  //Set memory for DIO/AIO
    MBT_SetIOSize(DISize,DOSize,AISize,AOSize);             //Set memory size for DIO/AIO
    MBT_Set_ModbusID(ModbusID);                             //Set local ID
}

int ModbusTCP_Run(void)
{
    int i;
    int Res;

    memset(&GPRSData,0,sizeof(_GPRS_DATA));
    Res = GM_GetPacket(&GPRSData);

    if(Res != 1) return;

    //  debug message for receive data
    for(i=0; i<GPRSData.RecvDataLen; i++)
    {
        if(!(i%10)) Print("\r\n[%d]\t",i);
        Print("%02X ",GPRSData.RecvData[i]);
    }
    Print("\r\n");

    //check modbus TCP command and Get memory data
    SendLen = MBT_ModbusTCP_Listen(GPRSData.RecvData,SendData);
    if(SendLen <= 0) return;

    //  debug message for send data
    for(i=0; i<SendLen; i++)
    {
        if(!(i%10)) Print("\r\n[%d]\t",i);
        Print("%02X ",SendData[i]);
    }
    Print("\r\n");

    while(1)
    {
        Res = GM_SendData(GPRSData.Client_Socket,SendData,SendLen);

        if(Res == 0) continue;
        else if(Res == 1)  Print("Send OK!!\r\n");
        else if(Res == -1) Print("cmd Error\r\n");
        else if(Res == -2) Print("modem isn't initial\r\n");
        else if(Res == -3) Print("Client num is error\r\n");
        else if(Res == -4) Print("Send len is error\r\n");
        else if(Res == -5) Print("Client isn't connection\r\n");

        break;
    }
}
char ServerPort[7] = {"502"}; // Server port
int Server_Init(void)
{
    int Res;
    Print("Waiting register");

    while(GM_CheckInitStatus() != GM_NOERROR)
    {
        Print(".");
        DelayMs(1000);
    }
    Print("\r\n");

    while(1) //Create TCP server
    {
        Res = GM_CreateServer(ServerPort);

        if(Res == 0) continue;
        else if(Res == -1) Print("cmd Error\r\n");
        else if(Res == -2) Print("modem isn't initial\r\n");
        else if(Res == -3) Print("LocalPort is error\r\n");
        else if(Res == 1) Print("Creat Server succeed!!\r\n");

        break;
    }
    return 1;
}

void refreshIOValue(void)
{
	static int iProcess=0;
    int i, iValue;
    float fValue;

    switch(iProcess)
    {
        case 0:
            /* Analog input (Ch0) ==> Modbus Memory */
            fValue=X305IO_AnalogIn(0);
            Memory_AI[0]=(int)(fValue*1638.35); /* (fValue/20.0*32767.0) */

            /* Analog input (Ch1) ==> Modbus Memory */
            fValue=X305IO_AnalogIn(1);
            Memory_AI[1]=(int)(fValue*1638.35);

            /* Analog input (Ch2) ==> Modbus Memory */
            fValue=X305IO_AnalogIn(2);
            Memory_AI[2]=(int)(fValue*1638.35);

            /* Analog input (Ch3) ==> Modbus Memory */
            fValue=X305IO_AnalogIn(3);
            Memory_AI[3]=(int)(fValue*1638.35);

            iProcess=1;
            break;

        case 1:
            /* Analog input (Ch4) ==> Modbus Memory */
            fValue=X305IO_AnalogIn(4);
            Memory_AI[4]=(int)(fValue*1638.35);

            /* Analog input (Ch5) ==> Modbus Memory */
            fValue=X305IO_AnalogIn(5);
            Memory_AI[5]=(int)(fValue*1638.35);

            /* Analog input (Ch6) ==> Modbus Memory */
            fValue=X305IO_AnalogIn(6);
            Memory_AI[6]=(int)(fValue*1638.35);

            /* Analog input (Ch7) ==> Modbus Memory */
            fValue=X305IO_AnalogIn(7);
            Memory_AI[7]=(int)(fValue*1638.35);

            iProcess=2;
            break;

        case 2:
            /* Digital input ==> Modbus Memory */
            iValue=X305IO_Read_All_DI();
            for(i=0; i<3; i++) {
                if(iValue&0x01) Memory_DI[i]=1;
                else Memory_DI[i]=0;

                iValue>>=1;
            }

            iProcess=3;
            break;

        case 3:
            /* Modbus Memory ==> Digital output */
            iValue=0;
            for(i=0; i<3; i++) {
                if(Memory_DO[i]!=0) iValue+=(1<<i);
            }

            X305IO_Write_All_DO(iValue);

            iProcess=0;
            break;

        default:
            iProcess=0;
            break;
    }
}

int main()
{
    char TCPLibVer[30] = {0};
    int Res = 1;
    int Tmp = 99;
    int i;

    char SendClient;

    SYS_PROFILE UserProfile;

    memset(&UserProfile,0,sizeof(UserProfile));
    strcpy(UserProfile.WAPN,"INTERNET");

	InstallUserTimerFunction_ms(100, refreshIOValue); // the timer used to get the I/O value of G-4500(Time interval: 100ms)
	
    ModbusTCP_Init();

    GM_GetLibVer(TCPLibVer);
    Print("TCP lib:%s\r\n",TCPLibVer);

    GM_InitModem(UserProfile);
    Server_Init();

    while(Tmp != 0)
    {
        if(Res != 0 && Res!=2)
        {
            Print("\r\n");
            Print("(1)Get server status.\r\n");
            Print("(2)Run Modbus TCP slave.\r\n");
            Print("(3)Restart modem.\r\n");
            Print("(0)Quit.\r\n");
            Print("\r\n");
            Scanf("%d",&Tmp);
        }

        switch(Tmp)
        {
        case 1:
            Res = GM_GetServerInfo(&MyServer);
            if(Res == 1)
            {
                Print("MyServer.SPort:%u\r\n",MyServer.SPort);
                Print("MyServer.SIP:%s\r\n",MyServer.SIP);
                Print("MyServer.IsListening:%d\r\n",MyServer.IsListing);
                for(i=0; i<7; i++)
                {
                    Print("Client state:%d\r\n",MyServer.SMyClient[i].IsConnected);
                }
            }
            else if(Res == -1)
                Print("cmd Error");
            else if(Res == -2)
                Print("modem isn't initial");
            break;

        case 2:
            while(1)
            {
                ModbusTCP_Run();

                // Press "q" to exit
                if(Kbhit())
                {
                    Tmp = Getch();
                    if(Tmp == 'q') break;
                }
            }
            Res = 1;
            break;

        case 3:
            Res = GM_ResetModem();

            if(Res == -2) Print("modem isn't initial");
            else Res = Server_Init();
            break;

        default:
            break;
        }
    }
    GM_CloseLib();
}