Raspberry Pi Forums

Code: Select all

#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include <errno.h>
#include <wiringPi.h>
#include <wiringSerial.h>


int main()
{
	int fd;
	int i,j,k,numchar;
	char elm[10],data[10];
	
	fd=serialOpen("/dev/ttyUSB0",38400);
	
	if(fd<0)
	{
		fprintf(stderr,"Unable to open serial device:%s\n",strerror(errno));
		return 1;
	}
	
	while(1)
	{
		for(i=0;i<10;i++)
			data[i]='\0';
		for(i=0;i<10;i++)
			elm[i]='\0';
		serialPrintf(fd,"ATI");
		delay(1000);
		
		numchar=serialDataAvail(fd);
		
		printf("numchar=%d\n",numchar);
		
		if(numchar!=-1)
		{
			for(j=0;j<numchar;j++)
				elm[j]=serialGetchar(fd);
			printf("ELM Version=%s\n",elm);
		}
		else
			printf("Read Error");
			
		
		serialFlush(fd);
		
		serialPrintf(fd,"010D");
		delay(1000);
		
		numchar=serialDataAvail(fd);
		printf("numchar=%d\n",numchar);
		
		if(numchar!=-1)
		{
			for(k=0;k<numchar;k++)
				data[k]=serialGetchar(fd);
			printf("Speed Data=%s\n",data);
		}
		else
		printf("Read Error");
	}
		
	serialClose(fd);
	
	return(0);
}