gered/picoc
1
0
Fork 0
Code Issues Pull requests Packages Projects Releases Wiki Activity

added gps() parsing to SURVEYOR_HOST

Browse source 
git-svn-id: http://picoc.googlecode.com/svn/trunk@208 21eae674-98b7-11dd-bd71-f92a316d2d60
This commit is contained in:
surveyor.com 2009-03-15 21:24:16 +00:00
parent eff849ad28
commit 9962bcc3cc
1 changed files with 25 additions and 4 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

29
library_surveyor.c
View file

@ -1,6 +1,7 @@
#include "picoc.h" #include "picoc.h"
static int Blobcnt, Blobx1, Blobx2, Bloby1, Bloby2, Iy1, Iy2, Iu1, Iu2, Iv1, Iv2; static int Blobcnt, Blobx1, Blobx2, Bloby1, Bloby2, Iy1, Iy2, Iu1, Iu2, Iv1, Iv2;
static int GPSlatdeg, GPSlatmin, GPSlondeg, GPSlonmin, GPSalt, GPSfix, GPSsat, GPSutc;
void PlatformLibraryInit() void PlatformLibraryInit()
{ {
VariableDefinePlatformVar(NULL, "blobcnt", &IntType, (union AnyValue *)&Blobcnt, FALSE); VariableDefinePlatformVar(NULL, "blobcnt", &IntType, (union AnyValue *)&Blobcnt, FALSE);
@ -14,6 +15,14 @@ void PlatformLibraryInit()
VariableDefinePlatformVar(NULL, "u2", &IntType, (union AnyValue *)&Iu2, FALSE); VariableDefinePlatformVar(NULL, "u2", &IntType, (union AnyValue *)&Iu2, FALSE);
VariableDefinePlatformVar(NULL, "v1", &IntType, (union AnyValue *)&Iv1, FALSE); VariableDefinePlatformVar(NULL, "v1", &IntType, (union AnyValue *)&Iv1, FALSE);
VariableDefinePlatformVar(NULL, "v2", &IntType, (union AnyValue *)&Iv2, FALSE); VariableDefinePlatformVar(NULL, "v2", &IntType, (union AnyValue *)&Iv2, FALSE);
VariableDefinePlatformVar(NULL, "gpslatdeg", &IntType, (union AnyValue *)&GPSlatdeg, FALSE);
VariableDefinePlatformVar(NULL, "gpslatmin", &IntType, (union AnyValue *)&GPSlatmin, FALSE);
VariableDefinePlatformVar(NULL, "gpslondeg", &IntType, (union AnyValue *)&GPSlondeg, FALSE);
VariableDefinePlatformVar(NULL, "gpslonmin", &IntType, (union AnyValue *)&GPSlonmin, FALSE);
VariableDefinePlatformVar(NULL, "gpsalt", &IntType, (union AnyValue *)&GPSalt, FALSE);
VariableDefinePlatformVar(NULL, "gpsfix", &IntType, (union AnyValue *)&GPSfix, FALSE);
VariableDefinePlatformVar(NULL, "gpssat", &IntType, (union AnyValue *)&GPSsat, FALSE);
VariableDefinePlatformVar(NULL, "gpsutc", &IntType, (union AnyValue *)&GPSutc, FALSE);
} }
void Csignal(struct ParseState *Parser, struct Value *ReturnValue, struct Value **Param, int NumArgs) // check for kbhit, return t or nil void Csignal(struct ParseState *Parser, struct Value *ReturnValue, struct Value **Param, int NumArgs) // check for kbhit, return t or nil
@ -214,13 +223,26 @@ void Ccompass(struct ParseState *Parser, struct Value *ReturnValue, struct Value
unsigned int ix; unsigned int ix;
i2c_data[0] = 0x41; // read compass twice to clear last reading i2c_data[0] = 0x41; // read compass twice to clear last reading
i2cread(0x21, (unsigned char *)i2c_data, 2, SCCB_ON); i2cread(0x22, (unsigned char *)i2c_data, 2, SCCB_ON);
i2c_data[0] = 0x41; i2c_data[0] = 0x41;
i2cread(0x21, (unsigned char *)i2c_data, 2, SCCB_ON); i2cread(0x22, (unsigned char *)i2c_data, 2, SCCB_ON);
ix = ((i2c_data[0] << 8) + i2c_data[1]) / 10; ix = ((i2c_data[0] << 8) + i2c_data[1]) / 10;
ReturnValue->Val->Integer = ix; ReturnValue->Val->Integer = ix;
} }
void Cgps(struct ParseState *Parser, struct Value *ReturnValue, struct Value **Param, int NumArgs)
{
gps_parse();
GPSlatdeg = gps_gga.latdeg;
GPSlatmin = gps_gga.latmin;
GPSlondeg = gps_gga.londeg;
GPSlonmin = gps_gga.lonmin;
GPSalt = gps_gga.alt;
GPSfix = gps_gga.fix;
GPSsat = gps_gga.sat;
GPSutc = gps_gga.utc;
}
void Creadi2c(struct ParseState *Parser, struct Value *ReturnValue, struct Value **Param, int NumArgs) // syntax val = readi2c(device, register); void Creadi2c(struct ParseState *Parser, struct Value *ReturnValue, struct Value **Param, int NumArgs) // syntax val = readi2c(device, register);
{ {
unsigned char i2c_device, i2c_data[2]; unsigned char i2c_device, i2c_data[2];
@ -496,8 +518,6 @@ void Cnnlearnblob (struct ParseState *Parser, struct Value *ReturnValue, struct
/* list of all library functions and their prototypes */ /* list of all library functions and their prototypes */
struct LibraryFunction PlatformLibrary[] = struct LibraryFunction PlatformLibrary[] =
{ {
{ SayHello, "void sayhello()" },
{ PrintInteger, "void printint(int)" },
{ Csignal, "int signal()" }, { Csignal, "int signal()" },
{ Cinput, "int input()" }, { Cinput, "int input()" },
{ Cdelay, "void delay(int)" }, { Cdelay, "void delay(int)" },
@ -517,6 +537,7 @@ struct LibraryFunction PlatformLibrary[] =
{ Cvmean, "void vmean()" }, { Cvmean, "void vmean()" },
{ Cvblob, "int vblob(int, int)" }, { Cvblob, "int vblob(int, int)" },
{ Ccompass, "int compass()" }, { Ccompass, "int compass()" },
{ Cgps, "void gps()" },
{ Creadi2c, "int readi2c(int, int)" }, { Creadi2c, "int readi2c(int, int)" },
{ Creadi2c2, "int readi2c2(int, int)" }, { Creadi2c2, "int readi2c2(int, int)" },
{ Cwritei2c, "void writei2c(int, int, int)" }, { Cwritei2c, "void writei2c(int, int, int)" },