/* ***************************************************************************************
** OnGetSerialPorts Checks for a valid 3dm-gx3-25 device and if found
** gets a connection and returns the portnumber
**
*****************************************************************************************/
int OnGetSerialPorts()
{
int i_count, t_count=0;
unsigned char c_name[20];
int i_errorCode = 0;
int i_portNum = 0;
char c_check[]="3DM-GX3";
char Verity[20];
for(i_count=2; i_count<257; i_count++)
{
int i_portNum = i3dmgx3_openPort(i_count, 115200, 8, 0, 1, 1024, 1024);
if (i_portNum>0) {
i_errorCode = i3dmgx3_getDeviceIdentiy(i_portNum, 2, &c_name[0]);
memcpy(Verity,c_name,20);
if (strstr(Verity,c_check) != NULL){
return i_portNum;
} //End string compare
else i3dmgx3_closeDevice(i_count);
}// end open port
}// end for loop
printf("No 3DM-GX3 devices found, please check connections\n");
return -1;
}
int GetComPort(){
s16 vvportNum = 0;
int iComPort = 0;
int errCount = 0;
int MaxFail = 5;
//Get comport number ask user for the comport number and open it
while(vvportNum == 0)
{
printf("Enter Comport to use:");
scanf("%d", &iComPort);
/* open a port, map a device */
vvportNum = i3dmgx3_openPort(iComPort, 115200, 8, 0, 1, 1024, 1024);
if (vvportNum<0) {
printf("port open failed. ");
printf("Comm error %d, %s:\n", vvportNum, explainError(vvportNum));
if (errCount++ >= MaxFail)
exit(-1);
iComPort = 0;
}
else {
printf("\n Using Comm Port #%d \n", vvportNum);
}
}
return vvportNum;
}
//===========================================================================
// GetComPort
//---------------------------------------------------------------------------
// Description: Prompt user for the comport and then opens it. The user is
// prompted until a valid comport is selected and successfully
// opened.
//
// Return: HANDLE - handle to the opened comport
//===========================================================================
int GetComPort()
{
int portNum = 0;
int iComPort = 0;
int errCount = 0;
int MaxFail = 5;
//Get comport number ask user for the comport number and open it
while(portNum == 0)
{
printf("Enter Comport to use:");
scanf("%d", &iComPort);
if(iComPort <2 || iComPort > 256){
printf(" please enter a valid port number \n");
printf(" valid ports are betweeen 2 and 256\n");
if (errCount++ >= MaxFail)
exit(-1);
}
else{
/* open a port */
portNum = i3dmgx3_openPort(iComPort, 115200, 8, 0, 1, 1024, 1024);
if (portNum<0) {
printf("port open failed. ");
printf("Comm error %d, %s:\n", portNum, explainError(portNum));
if (errCount++ >= MaxFail)
exit(-1);
iComPort = 0;
}
else {
printf("\n Using Comm Port #%d \n", portNum);
}
}
}
return portNum;
}
int main(int argc, char* argv[])
{
BOOL bQuit = FALSE;
BOOL bPrintHeader = TRUE;
int portNum = 0;
int tryPortNum;
int Ccount = 0;
printf("\n 3DM-GX3 Read and Write Data Rate\n");
/*-------- If user specifies a port, then use it */
if (argc > 1) {
tryPortNum = atoi(argv[1]);
if (tryPortNum < 2 || tryPortNum > 256) {
printf(" usage: DataRate <portNumber>\n");
printf(" valid ports are 2..256\n");
exit(1);
}
/*-------- open a port, map a device */
portNum = i3dmgx3_openPort(tryPortNum, 115200, 8, 0, 1, 1024, 1024);
if (portNum<0) {
printf(" port open failed.\n");
printf(" Comm error %d, %s: ", portNum, explainError(portNum));
exit(1);
}
}else{
portNum=OnGetSerialPorts();
if(portNum<0)
exit(1);
}
printf("\n 3DM-GX3-25 Using COM Port #%d \n", portNum);
while(!bQuit){
int chOption = 0;
if(bPrintHeader)
{
printf("\n");
printf("Enter an Option: (D)ata Rate (C)ontinuous (L)og_Continuous (Q)uit\n");
printf("D Data Rate - Modify or review the current Data Rate \n");
printf("C Continuous - Put the node in continuous mode and print each record\n");
printf("L Log Continuous - Put the node in continuous mode log and print each record\n");
printf("Q Quit - Quit the application\n");
bPrintHeader = FALSE;
}
//read option from the keyboard
while(!ReadCharNoReturn(&chOption))
{
Sleep(50);
}
//
switch(chOption)
{
case 'D':
case 'd': SetDataRate(portNum); bPrintHeader = TRUE; break;
case 'C':
case 'c': ReadContinuousData(portNum); bPrintHeader = TRUE; break;
case 'L':
case 'l':
ReadContinuousLogData(portNum);
bPrintHeader = TRUE;
break;
case 'q':
case 'Q': bQuit = TRUE; break;
case 'h':
case 'H': bPrintHeader = TRUE; break;
default: printf("Invalid Option\n\n"); bPrintHeader = TRUE;
}
}
return 0;
}
/*--------------------------------------------------------------------*/
int main(int argc, char **argv) {
s32 zvert=0;
BOOL endloopy = FALSE;
s16 portNum;
s16 deviceNum = 0;
s16 i;
s16 Ccount=0;
u16 value=0;
s16 id_flag = 0;
s16 errorCode;
s16 tryPortNum = 1;
unsigned char Record[79]; //record returned from device read where max size is 79
C2Accel_AngRecord Accel_AngRecord;
printf("\n 3DM-GX3 Read Acceleration and Angular Rate\n");
/*-------- If user specifies a port, then use it */
if (argc > 1) {
tryPortNum = atoi(argv[1]);
if (tryPortNum < 2 || tryPortNum > 256) {
printf(" usage: i3dmgx3 <portNumber>\n");
printf(" valid ports are 2..256\n");
exit(1);
}
/*-------- open a port, map a device */
portNum = i3dmgx3_openPort(tryPortNum, 115200, 8, 0, 1, 1024, 1024);
if (portNum<0) {
printf(" port open failed.\n");
printf(" Comm error %d, %s: ", portNum, explainError(portNum));
goto Exit;
}
}else{
portNum=OnGetSerialPorts();
if(portNum<0)
goto Exit;
}
printf("\n Using COM Port #%d \n", portNum);
/*-------- Set Comm Timeout values */
errorCode = setCommTimeouts(portNum, 50, 50); /* Read & Write timeout values */
if (errorCode!=I3DMGX3_COMM_OK) {
printf(" setCommTimeouts failed on port:%d with errorcode:%d\n",portNum,errorCode);
goto Exit;
}
/*-------- Disclose the byte order of host */
if( TestByteOrder() !=BIG_ENDIAN)
printf(" (Local Host is in Little Endian format)\n");
else
printf(" (Local Host is in Big Endian format)\n");
printf("\n");
/*-------- 0xC2 Accel and Ang rate Output --- Accel x y z and Ang x y z */
printf("\n 0xC2 Accel and Ang Output \n");
errorCode = i3dmgx3_AccelAndAngRate(portNum, &Record[0]);
if (errorCode < 0){
printf(" Error Accel and AngRate - : %s\n", explainError(errorCode));
endloopy =TRUE;
}else{
for (i=0; i<3; i++) {
Accel_AngRecord.Accel[i] = FloatFromBytes(&Record[1 + i*4]); // extract float from byte array
Accel_AngRecord.AngRt[i] = FloatFromBytes(&Record[13 + i*4]); // extract float from byte array
}
printf("\n\tAccel X\t\tAccel Y\t\tAccel Z\n");
printf(" \t%f\t%f\t%f\n", Accel_AngRecord.Accel[0], Accel_AngRecord.Accel[1], Accel_AngRecord.Accel[2]);
printf("\n\t Ang X\t\t Ang Y\t\t Ang Z\n");
printf(" \t%f\t%f\t%f\n", Accel_AngRecord.AngRt[0], Accel_AngRecord.AngRt[1], Accel_AngRecord.AngRt[2]);
Accel_AngRecord.timer = convert2ulong(&Record[25]);
printf("\n Time Stamp: %u\n", Accel_AngRecord.timer);
}
Exit:
/*-------- close device */
if (portNum >= 0)
i3dmgx3_closeDevice(portNum);
/*-------- wait for user to respond before exiting */
printf("\nHit return to exit...\n");
while (getchar() == EOF);
return(0);
}
