Версия для печати темы

// 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);
}

//