00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00024 #include <stdio.h>
00025 #include "sceptre.h"
00026 #include "accelerometer.h"
00027
00028
00029 static FILE *p_accelerometer = NULL;
00030
00031
00037 bool_t accelerometer_init(void)
00038 {
00039 p_accelerometer = fopen("/accelero/1000000","r");
00040 if (p_accelerometer!=NULL) return true;
00041 return false;
00042 }
00043
00044
00051 int accelerometer_read(float *p_dst)
00052 {
00053 if (p_accelerometer!=NULL && p_dst!=NULL)
00054 {
00055 return fread(p_dst,sizeof(float),3,p_accelerometer);
00056 }
00057 return -1;
00058 }
00059
00060
00064 void accelerometer_close(void)
00065 {
00066 if (p_accelerometer!=NULL)
00067 {
00068 fclose(p_accelerometer);
00069 p_accelerometer = NULL;
00070 }
00071 }