/*
MBTM_GSM.c: Modbus TCP Master via 2G/3G

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

Project: MBTM_GSM.c
		 lib\G4500.lib
		 lib\GSM_U2.lib
		 lib\OS7_COM.lib
		 lib\MCU2LIB.lib
		 lib\ModGPRS.lib

Hardware: G-4513

[Feb 17, 2015] by William
*/

#include <string.h>
#include "lib\G4500.h"
#include "lib\GSM_U2.h"
#include "lib\MCU2LIB.h"
#include "lib\OS7_COM.h"
#include "lib\ModGPRS.h"

unsigned char iMemory_DI[100];
unsigned char iMemory_DO[100];
          int iMemory_AI[100];
          int iMemory_AO[100];

#define MODBUS_FC1	1
#define MODBUS_FC2	2
#define MODBUS_FC3	3
#define MODBUS_FC4	4
		  
typedef struct MODBUSCMD
{
	int NetID;
	int FunCode;
	int WriteMemAddress;
	int RefAddress;
	int BitCounter;
}str_ModbusCmd;

char ModCmdAddrName[5][30] = {{"NetID"},
						  {"Function code"},
						  {"Write Memory address"},
						  {"Refernce Address"},
						  {"Bit counter"}};
		  
str_ModbusCmd ModbusCmd;

//== this function controls the power of GSM module
void powerFunction(int lv)
{
	if(lv==0)
	{
		MCU2_EnableGSM(0);	//GSM Power OFF
	}else
	{
		MCU2_EnableGSM(1);	//GSM Power ON
	}
}

void printPacket(GPRSData gprsData)
{
	int i;
	static int no = 0;
	no++;
	Print("----new GPRS Data (%d)----\r\n", no);
	Print("IP:Port = %s:%d, from link = %d\r\n", gprsData.fromIP, gprsData.port, gprsData.link);
	Print("Data length = %d\r\n", gprsData.dataLen);
	Print("Data = \r\n");
	for(i=0; i<gprsData.dataLen; i++)
	{
		Putch(gprsData.data[i]);
	}
	Print("\r\n------------------\r\n");
}

#define ModCmdLen	5

int main(void)
{
	int iAction=1, quit=1;
	int i, j;
	int tmp;
	int libVer;
	char libDate[20];
	int Result=0;
	int send_n;
	NetProfile netProfile;
	SYSProfile sysProfile;
	GPRSData gprsData;
	char serverIP[16];
	int serverPort;
	char ModbusBuf[512];
	long socket_n;
	int netSendStatus = 0;
	char myIP[16];
	int iRet = 0;
	int *ptr_ModCmd = (int *)&ModbusCmd;
	
	//-- init
	InitLib();

	//-- print G4500 lib. version
	GetLibDate(libDate);
    libVer=GetLibVersion();
	Print("G4500.Lib vesion %X.%02X, Date:%s\r\n", libVer>>8, libVer&0xff, libDate);

	//-- print GSM_U2 lib. version
	GM_SYS_GetLibDate(libDate);
	libVer = GM_SYS_GetLibVersion();
	Print("GSM LIB vesion %X.%02X, Date:%s\r\n", libVer>>8, libVer&0xff, libDate);
	
	//-- print MCU2 lib. version
	MCU2_getLibVer(libDate);
	Print("MCU2 LIB vesion : %s\r\n", libDate);
	
	//-- initial MCU2
	Result = MCU2_init();
	if(Result!=0)
	{
		Print("MCU2 initial fail\r\n");
		return 1;
	}else
	{
		MCU2_getFWVer(libDate);
		Print("MCU2 FW version: %s\r\n", libDate);
	}
	
	//-- Init Modbus lib
	InitGPRSModbus(iMemory_DI, iMemory_DO, iMemory_AI, iMemory_AO);

	//---- init modem
	strcpy(sysProfile.PINCode, "0000");	//The pin code	of SIM card, ex: "0000"
	sysProfile.modemPort = 4;	//modem port number. G-4500 = 4, uP-5000 = 11
	sysProfile.hardware = 0;	//hardware type. 1: G-4500, 2: uPAC-5000, 3: iP-8000, 0: Other
	GM_SYS_SetPowerFunction(powerFunction);//set power-control function
	if( (Result = GM_SYS_InitModem(sysProfile)) == GM_NOERROR)
		Print("init_modem success!!\r\n");
	else{
		Print("init_modem fail!! return value is %d\r\n", Result);
		return 1;
	}
	
	while(GM_SYS_CheckModemStatus() != GM_NOERROR)
	{
		Print("wait modem register...\r\n");
		DelayMs(1000);
	}
	Print("modem registered!!\r\n");
	
	while(iAction!=0)
	{
		iAction=0;
		quit=0;

        Print("\r\n");
		Print("1) Modbus TCP Master demo\r\n");
		Print("2) check signal quality\r\n");
		Print("3) check registered?\r\n");
        Print("\r\n");
        Print("0) Quits demo program\r\n");
        Print("Choose an option and press [Enter]: ");
        Scanf("%d", &iAction);
        Print("\r\n");

		switch(iAction)
		{
		case 1://Modbus TCP Master demo
			Print("Modbus TCP Master demo start\r\n");

			// set Network profile
			strcpy(netProfile.APN, "INTERNET");	//APN for network provided by your cellular provider
			strcpy(netProfile.pw, "");			//username for network provided by your cellular provider
			strcpy(netProfile.user, "");		//password for network provided by your cellular provider
			//The most basic task of DNS is to translate hostnames such as www.icpdas.com to IP address such as 96.9.41.131.
			strcpy(netProfile.DnsServerIP, "");	//empty string = system default value
			GM_NET_SetNet(netProfile);

			//set ip, port of server
			Print("please input server IP:(ex: 74.125.227.48)\r\n");
			Scanf("%s", serverIP);
			Print("please input server Port:(ex: 80)\r\n");
			Scanf("%d", &serverPort);

			//--(1) install link[0], GM_NET_InstallLink(0, 0, serverIP, serverPort) for UDP
			GM_NET_InstallLink(0, 1, serverIP, serverPort);
			Print("linking...\r\n");
			socket_n = 0;	//count for the packets
			while (1)
			{				
				// press "ESC" to exit
				if(Kbhit())
				{
					tmp = Getch();
					if( tmp == 27 || tmp == 'q')
						break;
				}

				//--(2) check that could the modem service, if it can't, skip operating the modem below
				if(GM_SYS_CheckModemStatus() != GM_NOERROR)
					continue;

				if(GM_NET_GetLinkStatus(0)!=1)
					continue;
				else
					GM_NET_GetIP(myIP);

				//--(3) send the data to server, and when LinkStatus[1]=1
				switch((netSendStatus=GM_SYS_CheckCmdStatus()))
				{
				case GM_READY:
					Print("sending package[%8ld]..., myIP = %s\r\n", socket_n, myIP);
					gprsData.link = 0;
					
					Print("Please enter MODBUS TCP command:\r\n");
					for(i=0;i<ModCmdLen;i++)
					{
						Print("%s:",ModCmdAddrName[i]);
						Scanf("%d",ptr_ModCmd+i);
					}
					
					iRet = GPRSModbusTCP_Master2Slave((char *)ModbusBuf, ModbusCmd.NetID, ModbusCmd.FunCode, ModbusCmd.WriteMemAddress
														, ModbusCmd.RefAddress, ModbusCmd.BitCounter);

					memset(gprsData.data,0,sizeof(gprsData.data));
					memcpy(gprsData.data,ModbusBuf,iRet);
					gprsData.dataLen = iRet;

					if(GM_NET_Send(gprsData.link, gprsData.data, gprsData.dataLen)!=GM_NOERROR)
						Print("can't send package[%8ld]\r\n");
					break;
				case GM_NOERROR:
					Print("send success!!\r\n");
					socket_n++;
					break;
				case GM_BUSY:	//sending, and waiting reply
					break;
				default:
					Print("send error, and re-send again, error code=%d\r\n", netSendStatus);
					break;
				}
				
				DelayMs(3000);
				
				//--(4) if any new data packet come in, print it
				memset(&gprsData,0,sizeof(GPRSData));
				
				if(GM_NET_GetNewPacket(&gprsData) != NULL)
				{
					iRet = GPRSModbusTCP_Receive((char *)gprsData.data,gprsData.dataLen);
					Print("iRet:%d\r\n",iRet);
					Print("Function code:%d\r\n",ModbusCmd.FunCode);
					
					for(i=0;i<gprsData.dataLen;i++)
					{
						if(!(i%10)) Print("\r\n[%2d]\t",i);
						Print("%02d\t",iMemory_AI[i]);       //because Function code is 4
					}
					Print("\r\n");
				}
			}
			
			GM_NET_CloseLink(0);//== Close client link[n], 3G:0~6, 2G:0
			GM_NET_CloseNet();
			break;

		case 2://check signal quality
			Result = GM_SYS_CheckSignal();
			Print("-----------------------------------\r\n");
			Print("signal value = %d\r\n", Result);
			Print("signal quality:\r\n");
			Print("0		-113 dBm or less\r\n");
			Print("1		-111 dBm\r\n");
			Print("2~30		-109... -53 dBm\r\n");
			Print("31		-51 dBm or greater\r\n");
			Print("99		not known or not detectable\r\n");
			Print("-----------------------------------\r\n");
			break;

		case 3://check register value
			Result = GM_SYS_CheckReg();
			Print("-----------------------------------\r\n");
			Print("register value = %d  (0:no register, 1:registered, 2:registering)\r\n", Result);
			Print("register flag:\r\n");
			Print("	0:	not registered\r\n");
			Print("	1:	registered, home network\r\n");
			Print("	2:	not registered, and searching...\r\n");
			Print("	3:	registration denied\r\n");
			Print("	4:	unknown\r\n");
			Print("	5:	registered, roaming\r\n");
			Print("-----------------------------------\r\n");
			break;

		case 0:
		default:
			quit=1;
			break;

		}//end switch()

		if(!quit)
		{
			Print("Press any key to continue...\r\n");
			Getch();
		}
	}//end while(1)

	//must close before program ending to release you resource
	GM_SYS_CloseModem(0);	//== Close the modem, 0:not turn off modem, 1:turn off modem

	Print("Please press ENTER to exit...\r\n");

	Getch();
	return 0;
}