vcs.maemo.org Git - eyes-widget/blob - src/accelerometer.c

   1 // Based on GPL code from liqbase, copyright Gary Liquid <liquid@gmail.com>
   2
   3 #include <stdio.h>
   4 #include <glib.h>
   5 #include "accelerometer.h"
   6
   7 static int ocnt=0;
   8 static int oax=0;
   9 static int oay=0;
  10 static int oaz=0;
  11
  12 static const char *accel_filename = "/sys/class/i2c-adapter/i2c-3/3-001d/coord";
  13 //static const char *accel_filename = "/tmp/coord";
  14
  15 int accel_read(gint *ax,gint *ay,gint *az)
  16 {
  17         FILE *fd;
  18         int rs;
  19         fd = fopen(accel_filename, "r");
  20         if(fd==NULL){  return -1;}
  21         rs=fscanf((FILE*) fd,"%i %i %i",ax,ay,az);
  22         fclose(fd);
  23         if(rs != 3){ return -2;}
  24         int bx=*ax;
  25         int by=*ay;
  26         int bz=*az;
  27         if(ocnt>0)
  28         {
  29                 *ax=oax+(bx-oax)*0.1;
  30                 *ay=oay+(by-oay)*0.1;
  31                 *az=oaz+(bz-oaz)*0.1;
  32         }
  33         oax=*ax;
  34         oay=*ay;
  35         oaz=*az;
  36         ocnt++;
  37         return 0;
  38 }
  39