#include <stdio.h>
#include <stdlib.h>
#include <string.h>
typedef unsigned char u8;
static const unsigned int crctab16[] =
{
0X0000, 0X1189, 0X2312, 0X329B, 0X4624, 0X57AD, 0X6536, 0X74BF,
0X8C48, 0X9DC1, 0XAF5A, 0XBED3, 0XCA6C, 0XDBE5, 0XE97E, 0XF8F7,
0X1081, 0X0108, 0X3393, 0X221A, 0X56A5, 0X472C, 0X75B7, 0X643E,
0X9CC9, 0X8D40, 0XBFDB, 0XAE52, 0XDAED, 0XCB64, 0XF9FF, 0XE876,
0X2102, 0X308B, 0X0210, 0X1399, 0X6726, 0X76AF, 0X4434, 0X55BD,
0XAD4A, 0XBCC3, 0X8E58, 0X9FD1, 0XEB6E, 0XFAE7, 0XC87C, 0XD9F5,
0X3183, 0X200A, 0X1291, 0X0318, 0X77A7, 0X662E, 0X54B5, 0X453C,
0XBDCB, 0XAC42, 0X9ED9, 0X8F50, 0XFBEF, 0XEA66, 0XD8FD, 0XC974,
0X4204, 0X538D, 0X6116, 0X709F, 0X0420, 0X15A9, 0X2732, 0X36BB,
0XCE4C, 0XDFC5, 0XED5E, 0XFCD7, 0X8868, 0X99E1, 0XAB7A, 0XBAF3,
0X5285, 0X430C, 0X7197, 0X601E, 0X14A1, 0X0528, 0X37B3, 0X263A,
0XDECD, 0XCF44, 0XFDDF, 0XEC56, 0X98E9, 0X8960, 0XBBFB, 0XAA72,
0X6306, 0X728F, 0X4014, 0X519D, 0X2522, 0X34AB, 0X0630, 0X17B9,
0XEF4E, 0XFEC7, 0XCC5C, 0XDDD5, 0XA96A, 0XB8E3, 0X8A78, 0X9BF1,
0X7387, 0X620E, 0X5095, 0X411C, 0X35A3, 0X242A, 0X16B1, 0X0738,
0XFFCF, 0XEE46, 0XDCDD, 0XCD54, 0XB9EB, 0XA862, 0X9AF9, 0X8B70,
0X8408, 0X9581, 0XA71A, 0XB693, 0XC22C, 0XD3A5, 0XE13E, 0XF0B7,
0X0840, 0X19C9, 0X2B52, 0X3ADB, 0X4E64, 0X5FED, 0X6D76, 0X7CFF,
0X9489, 0X8500, 0XB79B, 0XA612, 0XD2AD, 0XC324, 0XF1BF, 0XE036,
0X18C1, 0X0948, 0X3BD3, 0X2A5A, 0X5EE5, 0X4F6C, 0X7DF7, 0X6C7E,
0XA50A, 0XB483, 0X8618, 0X9791, 0XE32E, 0XF2A7, 0XC03C, 0XD1B5,
0X2942, 0X38CB, 0X0A50, 0X1BD9, 0X6F66, 0X7EEF, 0X4C74, 0X5DFD,
0XB58B, 0XA402, 0X9699, 0X8710, 0XF3AF, 0XE226, 0XD0BD, 0XC134,
0X39C3, 0X284A, 0X1AD1, 0X0B58, 0X7FE7, 0X6E6E, 0X5CF5, 0X4D7C,
0XC60C, 0XD785, 0XE51E, 0XF497, 0X8028, 0X91A1, 0XA33A, 0XB2B3,
0X4A44, 0X5BCD, 0X6956, 0X78DF, 0X0C60, 0X1DE9, 0X2F72, 0X3EFB,
0XD68D, 0XC704, 0XF59F, 0XE416, 0X90A9, 0X8120, 0XB3BB, 0XA232,
0X5AC5, 0X4B4C, 0X79D7, 0X685E, 0X1CE1, 0X0D68, 0X3FF3, 0X2E7A,
0XE70E, 0XF687, 0XC41C, 0XD595, 0XA12A, 0XB0A3, 0X8238, 0X93B1,
0X6B46, 0X7ACF, 0X4854, 0X59DD, 0X2D62, 0X3CEB, 0X0E70, 0X1FF9,
0XF78F, 0XE606, 0XD49D, 0XC514, 0XB1AB, 0XA022, 0X92B9, 0X8330,
0X7BC7, 0X6A4E, 0X58D5, 0X495C, 0X3DE3, 0X2C6A, 0X1EF1, 0X0F78,
};
// calculate the 16-bit CRC of data with predetermined length.
unsigned int GetCrc16(const unsigned char* pData, int nLength)
{
unsigned int fcs = 0xffff; // initialization
while(nLength>0)
{
fcs = (fcs >> 8) ^ crctab16[(fcs ^ *pData) & 0xff];
nLength--;
pData++;
}
return ~fcs; // negated
}
u8 gt06_protocol3[40];
u8 gt06_protocol4[50];
//unsigned char* information_content;
unsigned char gt06_ldp_packet_framing(unsigned short int get06_ldp_pack_len, unsigned char *information_content,unsigned short int counter)
{
u8 get06_ldp_start_bytes[2]={0x78,0x78,0x00};
//u8 protocol_num;
//unsigned short int serial_num = 0x1F;
unsigned short int gt06_ldp_len = 0;
unsigned short int gt06_ldp_check_sum = 0;
unsigned char stop_bytes[2]={0x0D,0x0A,0x00};
unsigned char gt06_ldp_protocol[100]={0};
unsigned char gt06_ldp_protocol2[40]={0};
unsigned char gt06_ldp_protocol5[40]={0};
unsigned char *gt06_ldp_protocol6;
// printf("inside fn gt06 ldp packet\n");
//memset(gt06_ldp_protocol,0,sizeof(gt06_ldp_protocol));
strcat(gt06_ldp_protocol,get06_ldp_start_bytes);
// printf("%x \n",gt06_ldp_protocol);
gt06_ldp_protocol[2] = 5 + strlen((char *)information_content);// 38;// packect length
gt06_ldp_protocol[3] = 0x12;// protocol number
strncat(gt06_ldp_protocol,information_content,strlen((char *)information_content));// information content ex : imei
gt06_ldp_len = strlen((char *)gt06_ldp_protocol);
gt06_ldp_protocol[gt06_ldp_len++] =counter>>8;
gt06_ldp_protocol[gt06_ldp_len++] = counter;
gt06_ldp_check_sum = GetCrc16(gt06_ldp_protocol+2,gt06_ldp_len-2);
//printf("cnt = %x \n",gt06_ldp_check_sum);
gt06_ldp_protocol[gt06_ldp_len++] = gt06_ldp_check_sum>>8;
gt06_ldp_protocol[gt06_ldp_len++] = gt06_ldp_check_sum;
gt06_ldp_protocol[gt06_ldp_len++] = stop_bytes[0];
gt06_ldp_protocol[gt06_ldp_len++] = stop_bytes[1];
//memcpy(gt06_protocol3,gt06_ldp_protocol,gt06_ldp_len);
for(char i=0;i<gt06_ldp_len;i++)
{
printf("%x ",gt06_ldp_protocol[i]);
// sprintf(gt06_ldp_protocol2,"%x",gt06_ldp_protocol[i]);
//strcat(gt06_ldp_protocol5,gt06_ldp_protocol2);
}
memcpy(gt06_protocol3,gt06_ldp_protocol,gt06_ldp_len);
gt06_ldp_protocol6=gt06_protocol3;
return gt06_ldp_protocol6;
}
void main()
{
//unsigned char information_content[30]={0x1F,0x12,0x0B,0x08,0x1D,0x11,0x2E,0x10,0xcf,0x02,0x7A,0xC7,0xEB,0x0C,0x46,0x58,0x49,0x01,0x14,0x8F,0x01,0x95,0x31,0x28,0x7D,0x01,0x1F,0xB8,0x00};
unsigned char information_content[100]={0};
unsigned char packet_reply;
unsigned short int get06_ldp_pack_len=0;
unsigned short int counter=3;
u8 get06_ldp_proto_num[1]={0x12,0x00};
u8 get06_ldp_datetime[6]={0x0B,0x08,0x1D,0x11,0x2E,0x10,0x00};
u8 get06_ldp_sat[1]={0xcf,0x00};
u8 get06_ldp_lat[4]={0x02,0x7A,0xC7,0xEB,0x00};
u8 get06_ldp_long[4]={0x0C,0x46,0x58,0x49,0x00};
u8 get06_ldp_speed[1]={0x01,0x00};
u8 get06_ldp_course[2]={0x14,0x8F,0x00};
// u8 get06_ldp_mcc[2]={0x01,0x95,0x00};//country code::india:404,405,406
// u8 get06_ldp_mnc[1]={0x31,0x00};//airtel 49
// u8 get06_ldp_lac[2]={0x28,0x7D,0x00};
// u8 get06_ldp_cell_id[3]={0x01,0x1F,0xB8,0x00};
memset(information_content,0,sizeof(information_content));
memcpy(information_content,get06_ldp_datetime,6);
get06_ldp_pack_len += 6;
memcpy(information_content+get06_ldp_pack_len,get06_ldp_sat,1);
get06_ldp_pack_len += 1;
memcpy(information_content+get06_ldp_pack_len,get06_ldp_lat,4);
get06_ldp_pack_len += 4;
memcpy(information_content+get06_ldp_pack_len,get06_ldp_long,4);
get06_ldp_pack_len += 4;
memcpy(information_content+get06_ldp_pack_len,get06_ldp_speed,1);
get06_ldp_pack_len += 1;
memcpy(information_content+get06_ldp_pack_len,get06_ldp_course,2);
get06_ldp_pack_len += 2;
/*
memcpy(information_content+get06_ldp_pack_len,get06_ldp_mcc,2);
get06_ldp_pack_len += 2;
memcpy(information_content+get06_ldp_pack_len,get06_ldp_mnc,1);
get06_ldp_pack_len += 1;
memcpy(information_content+get06_ldp_pack_len,get06_ldp_lac,2);
get06_ldp_pack_len += 2;
memcpy(information_content+get06_ldp_pack_len,get06_ldp_cell_id,3);
get06_ldp_pack_len += 3;
*/
packet_reply = gt06_ldp_packet_framing(0x12,information_content,counter);
//
printf("\ngt06_protocol3=%x\n",gt06_protocol3);
// printf("\packet_reply=%d\n",packet_reply);
return 0;
}