2 #include "simpletools.h" 5 void init_MMA7660FC(
void);
6 int raw2g100(
char gRaw);
10 volatile int bt_accelInitFlag = 0;
11 volatile int eei2cLock;
12 volatile int eei2cLockFlag;
14 void init_MMA7660FC(
void)
17 unsigned char val = 0;
22 eei2cLock = locknew();
26 if(!st_eeInitFlag) ee_init();
27 while(lockset(eei2cLock));
28 i2c_out(st_eeprom, MMA7660_I2C,
30 i2c_out(st_eeprom, MMA7660_I2C,
32 i2c_out(st_eeprom, MMA7660_I2C,
35 i2c_out(st_eeprom, MMA7660_I2C,
44 if(!st_eeInitFlag) ee_init();
45 unsigned char val = 0;
46 while(lockset(eei2cLock));
47 i2c_in (st_eeprom, MMA7660_I2C,
51 int g100 = raw2g100(val);
52 if(axis ==
AY) g100 = -g100;
56 void accels(
int *x,
int *y,
int *z)
65 int raw2g100(
char gRaw)
67 int g100 = (int) gRaw;
68 int sign = 1 & (g100 >> 5);
70 g100 = 0xFFFFFFC0 | g100;
73 g100 = g100 * 469 / 100;
const PropWare::SPI::Mode MODE