modules/control/motionlib.c

   1 /*****************************************************************************
   2  * motion.c: laptop built-in motion sensors
   3  *****************************************************************************
   4  * Copyright (C) 2006 - 2012 the VideoLAN team
   5  *
   6  * Author: Sam Hocevar <sam@zoy.org>
   7  *         Jérôme Decoodt <djc@videolan.org> (unimotion integration)
   8  *
   9  * This program is free software; you can redistribute it and/or modify
  10  * it under the terms of the GNU General Public License as published by
  11  * the Free Software Foundation; either version 2 of the License, or
  12  * (at your option) any later version.
  13  *
  14  * This program is distributed in the hope that it will be useful,
  15  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  16  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  17  * GNU General Public License for more details.
  18  *
  19  * You should have received a copy of the GNU General Public License
  20  * along with this program; if not, write to the Free Software
  21  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston MA 02110-1301, USA.
  22  *****************************************************************************/
  23
  24 #ifdef HAVE_CONFIG_H
  25 # include "config.h"
  26 #endif
  27
  28 #include <assert.h>
  29 #include <math.h>
  30 #include <unistd.h>
  31
  32 #include <vlc_common.h>
  33
  34 #ifdef __APPLE__
  35 # include "TargetConditionals.h"
  36 # if !TARGET_OS_IPHONE
  37 #  define HAVE_MACOS_UNIMOTION
  38 # endif
  39 #endif
  40
  41 #ifdef HAVE_MACOS_UNIMOTION
  42 # include "unimotion.h"
  43 #endif
  44
  45 #include "motionlib.h"
  46
  47 struct motion_sensors_t
  48 {
  49     enum { HDAPS_SENSOR, AMS_SENSOR, APPLESMC_SENSOR,
  50            UNIMOTION_SENSOR } sensor;
  51 #ifdef HAVE_MACOS_UNIMOTION
  52     enum sms_hardware unimotion_hw;
  53 #endif
  54     int i_calibrate;
  55
  56     int p_oldx[16];
  57     int i;
  58     int i_sum;
  59 };
  60
  61 motion_sensors_t *motion_create( vlc_object_t *obj )
  62 {
  63     FILE *f;
  64     int i_x = 0, i_y = 0;
  65
  66     motion_sensors_t *motion = malloc( sizeof( motion_sensors_t ) );
  67     if( unlikely( motion == NULL ) )
  68     {
  69         return NULL;
  70     }
  71
  72     if( access( "/sys/devices/platform/hdaps/position", R_OK ) == 0
  73         && ( f = fopen( "/sys/devices/platform/hdaps/calibrate", "re" ) ) )
  74     {
  75         /* IBM HDAPS support */
  76         motion->i_calibrate = fscanf( f, "(%d,%d)", &i_x, &i_y ) == 2 ? i_x: 0;
  77         fclose( f );
  78         motion->sensor = HDAPS_SENSOR;
  79         msg_Dbg( obj, "HDAPS motion detection correctly loaded" );
  80     }
  81     else if( access( "/sys/devices/ams/x", R_OK ) == 0 )
  82     {
  83         /* Apple Motion Sensor support */
  84         motion->sensor = AMS_SENSOR;
  85         msg_Dbg( obj, "AMS motion detection correctly loaded" );
  86     }
  87     else if( access( "/sys/devices/platform/applesmc.768/position", R_OK ) == 0
  88              && ( f = fopen( "/sys/devices/platform/applesmc.768/calibrate", "re" ) ) )
  89     {
  90         /* Apple SMC (newer macbooks) */
  91         /* Should be factorised with HDAPS */
  92         motion->i_calibrate = fscanf( f, "(%d,%d)", &i_x, &i_y ) == 2 ? i_x: 0;
  93         fclose( f );
  94         motion->sensor = APPLESMC_SENSOR;
  95         msg_Dbg( obj, "Apple SMC motion detection correctly loaded" );
  96     }
  97 #ifdef HAVE_MACOS_UNIMOTION
  98     else if( (motion->unimotion_hw = detect_sms()) )
  99     {
 100         motion->sensor = UNIMOTION_SENSOR;
 101         msg_Dbg( obj, "UniMotion motion detection correctly loaded" );
 102     }
 103 #endif
 104     else
 105     {
 106         /* No motion sensor support */
 107         msg_Err( obj, "No motion sensor available" );
 108         free( motion );
 109         return NULL;
 110     }
 111
 112     memset( motion->p_oldx, 0, sizeof( motion->p_oldx ) );
 113     motion->i = 0;
 114     motion->i_sum = 0;
 115     return motion;
 116 }
 117
 118 void motion_destroy( motion_sensors_t *motion )
 119 {
 120     free( motion );
 121 }
 122
 123 /*****************************************************************************
 124  * GetOrientation: get laptop orientation, range -1800 / +1800
 125  *****************************************************************************/
 126 static int GetOrientation( motion_sensors_t *motion )
 127 {
 128     FILE *f;
 129     int i_x = 0, i_y = 0, i_z = 0;
 130     int i_ret;
 131
 132     switch( motion->sensor )
 133     {
 134     case HDAPS_SENSOR:
 135         f = fopen( "/sys/devices/platform/hdaps/position", "re" );
 136         if( !f )
 137         {
 138             return 0;
 139         }
 140
 141         i_ret = fscanf( f, "(%d,%d)", &i_x, &i_y );
 142         fclose( f );
 143
 144         if( i_ret < 2 )
 145             return 0;
 146         else
 147             return ( i_x - motion->i_calibrate ) * 10;
 148
 149     case AMS_SENSOR:
 150         f = fopen( "/sys/devices/ams/x", "re" );
 151         if( !f )
 152         {
 153             return 0;
 154         }
 155
 156         i_ret = fscanf( f, "%d", &i_x);
 157         fclose( f );
 158
 159         if( i_ret < 1 )
 160             return 0;
 161         else
 162             return - i_x * 30; /* FIXME: arbitrary */
 163
 164     case APPLESMC_SENSOR:
 165         f = fopen( "/sys/devices/platform/applesmc.768/position", "re" );
 166         if( !f )
 167         {
 168             return 0;
 169         }
 170
 171         i_ret = fscanf( f, "(%d,%d,%d)", &i_x, &i_y, &i_z );
 172         fclose( f );
 173
 174         if( i_ret < 3 )
 175             return 0;
 176         else
 177             return ( i_x - motion->i_calibrate ) * 10;
 178
 179 #ifdef HAVE_MACOS_UNIMOTION
 180     case UNIMOTION_SENSOR:
 181         if( read_sms_raw( motion->unimotion_hw, &i_x, &i_y, &i_z ) )
 182         {
 183             double d_norm = sqrt( i_x*i_x+i_z*i_z );
 184             if( d_norm < 100 )
 185                 return 0;
 186             double d_x = i_x / d_norm;
 187             if( i_z > 0 )
 188                 return -asin(d_x)*3600/3.141;
 189             else
 190                 return 3600 + asin(d_x)*3600/3.141;
 191         }
 192         else
 193             return 0;
 194 #endif
 195     default:
 196         vlc_assert_unreachable();
 197     }
 198 }
 199
 200 /*****************************************************************************
 201  * motion_get_angle: get averaged laptop orientation, range -1800 / +1800
 202  *****************************************************************************/
 203 int motion_get_angle( motion_sensors_t *motion )
 204 {
 205     const int filter_length = ARRAY_SIZE( motion->p_oldx );
 206     int i_x = GetOrientation( motion );
 207
 208     motion->i_sum += i_x - motion->p_oldx[motion->i];
 209     motion->p_oldx[motion->i] = i_x;
 210     motion->i = ( motion->i + 1 ) % filter_length;
 211     i_x = motion->i_sum / filter_length;
 212
 213     return i_x;
 214 }
 215