Автор: quasist Пятница, 26 ноября 2010, 21:43
Если запустить и повертеть в руках - сразу стаёт ясно где какая ось
Код писал на основе GPHшного...
CODE
// G-SENSOR
#include "zlext/te9_tf9_hybrid_driver.h"
#include "zlext/te9_tf9_regs.h"
#include <sys/types.h>
#include <sys/ipc.h>
#include <sys/sem.h>
#include <sys/wait.h>
#include <sys/poll.h>
#include <signal.h>
#include <errno.h>
int accel_fd;
void zlInitGSensor()
{
accel_fd=open("/dev/accel",O_RDWR);
int oflag;
fcntl(accel_fd,F_SETOWN,getpid());
oflag=fcntl(accel_fd,F_GETFL);
fcntl(accel_fd,F_SETFL,oflag | FASYNC);
KIONIX_ACCEL_init();
}
void zlProcGSensor()
{
static ACCEL_XYZ accel_val;
KIONIX_ACCEL_enable_outputs();
KIONIX_ACCEL_read_LPF_cnt(&accel_val.x, &accel_val.y, &accel_val.z);
debug_v[0]=accel_val.x;
debug_v[1]=accel_val.y;
debug_v[2]=accel_val.z;
KIONIX_ACCEL_read_LPF_g(&accel_val.x, &accel_val.y, &accel_val.z);
debug_v[3]=accel_val.x;
debug_v[4]=accel_val.y;
debug_v[5]=accel_val.z;
}
void zlShutDownGSensor()
{
KIONIX_ACCEL_deinit();
close(accel_fd);
}
//