test/src/gyro.c

   1 /*
   2  * sensord
   3  *
   4  * Copyright (c) 2014 Samsung Electronics Co., Ltd.
   5  *
   6  * Licensed under the Apache License, Version 2.0 (the "License");
   7  * you may not use this file except in compliance with the License.
   8  * You may obtain a copy of the License at
   9  *
  10  * http://www.apache.org/licenses/LICENSE-2.0
  11  *
  12  * Unless required by applicable law or agreed to in writing, software
  13  * distributed under the License is distributed on an "AS IS" BASIS,
  14  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
  15  * See the License for the specific language governing permissions and
  16  * limitations under the License.
  17  *
  18  */
  19
  20 #include <time.h>
  21 #include <glib.h>
  22 #include <stdlib.h>
  23 #include <stdio.h>
  24 #include <sensor_internal.h>
  25 #include <stdbool.h>
  26 #include <string.h>
  27
  28 static GMainLoop *mainloop;
  29
  30 void callback(unsigned int event_type, sensor_event_data_t *event, void *user_data)
  31 {
  32         sensor_data_t *data = (sensor_data_t *)event->event_data;
  33         printf("Gyroscope [%lld] [%6.6f] [%6.6f] [%6.6f] \n\n", data->timestamp, data->values[0], data->values[1], data->values[2]);
  34 }
  35
  36 void printformat()
  37 {
  38         printf("Usage : ./gyro <event> <interval>(optional)\n\n");
  39         printf("event:\n");
  40         printf("RAW_DATA_REPORT_ON_TIME\n");
  41         printf("interval:\n");
  42         printf("The time interval should be entered based on the sampling frequency supported by gyroscope driver on the device in ms.If no value for sensor is entered default value by the driver will be used.\n");
  43 }
  44
  45 int main(int argc,char **argv)
  46 {
  47         int result, handle, start_handle, stop_handle;
  48         unsigned int event;
  49
  50         mainloop = g_main_loop_new(NULL, FALSE);
  51         sensor_type_t type = GYROSCOPE_SENSOR;
  52         event_condition_t *event_condition = (event_condition_t*) malloc(sizeof(event_condition_t));
  53         event_condition->cond_op = CONDITION_EQUAL;
  54         event_condition->cond_value1 = 10.52;
  55
  56         if (argc != 2 && argc != 3) {
  57                 printformat();
  58                 free(event_condition);
  59                 return 0;
  60         }
  61         else {
  62                  if (strcmp(argv[1], "RAW_DATA_REPORT_ON_TIME") == 0)
  63                         event = GYROSCOPE_EVENT_RAW_DATA_REPORT_ON_TIME;
  64
  65                  else {
  66                         printformat();
  67                         free(event_condition);
  68                         return 0;
  69                 }
  70
  71                 if(argc == 3)
  72                         event_condition->cond_value1 = atof(argv[2]);
  73         }
  74
  75         handle = sf_connect(type);
  76         result = sf_register_event(handle, event, event_condition, callback, NULL);
  77
  78         if (result < 0)
  79                 printf("Can't register gyroscope\n");
  80
  81         start_handle = sf_start(handle, 0);
  82
  83         if (start_handle < 0) {
  84                 printf("Error\n\n\n\n");
  85                 sf_unregister_event(handle, event);
  86                 sf_disconnect(handle);
  87                 return -1;
  88         }
  89
  90         g_main_loop_run(mainloop);
  91         g_main_loop_unref(mainloop);
  92
  93         sf_unregister_event(handle, event);
  94         stop_handle = sf_stop(handle);
  95
  96         if (stop_handle < 0) {
  97                 printf("Error\n\n");
  98                 return -1;
  99         }
 100
 101         sf_disconnect(handle);
 102
 103         free(event_condition);
 104
 105         return 0;
 106 }
 107