git.sesse.net Git - vlc/blob - modules/control/motion.c

   1 /*****************************************************************************
   2  * motion.c: control VLC with laptop built-in motion sensors
   3  *****************************************************************************
   4  * Copyright (C) 2006 - 2007 the VideoLAN team
   5  * $Id$
   6  *
   7  * Author: Sam Hocevar <sam@zoy.org>
   8  *         Jérôme Decoodt <djc@videolan.org> (unimotion integration)
   9  *
  10  * This program is free software; you can redistribute it and/or modify
  11  * it under the terms of the GNU General Public License as published by
  12  * the Free Software Foundation; either version 2 of the License, or
  13  * (at your option) any later version.
  14  *
  15  * This program is distributed in the hope that it will be useful,
  16  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  17  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  18  * GNU General Public License for more details.
  19  *
  20  * You should have received a copy of the GNU General Public License
  21  * along with this program; if not, write to the Free Software
  22  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston MA 02110-1301, USA.
  23  *****************************************************************************/
  24
  25 /*****************************************************************************
  26  * Preamble
  27  *****************************************************************************/
  28
  29 #ifdef HAVE_CONFIG_H
  30 # include "config.h"
  31 #endif
  32
  33 #include <math.h>
  34
  35 #include <vlc_common.h>
  36 #include <vlc_plugin.h>
  37 #include <vlc_interface.h>
  38 #include <vlc_vout.h>
  39
  40 #ifdef HAVE_UNISTD_H
  41 # include <unistd.h>
  42 #endif
  43
  44 #ifdef __APPLE__
  45 # include "TargetConditionals.h"
  46 # if !TARGET_OS_IPHONE
  47 #  define HAVE_MACOS_UNIMOTION
  48 # endif
  49 #endif
  50
  51 #ifdef HAVE_MACOS_UNIMOTION
  52 # include "unimotion.h"
  53 #endif
  54
  55 /*****************************************************************************
  56  * intf_sys_t: description and status of interface
  57  *****************************************************************************/
  58 struct intf_sys_t
  59 {
  60     enum { NO_SENSOR, HDAPS_SENSOR, AMS_SENSOR, APPLESMC_SENSOR,
  61            UNIMOTION_SENSOR } sensor;
  62 #ifdef HAVE_MACOS_UNIMOTION
  63     enum sms_hardware unimotion_hw;
  64 #endif
  65     int i_calibrate;
  66
  67     bool b_use_rotate;
  68 };
  69
  70 /*****************************************************************************
  71  * Local prototypes.
  72  *****************************************************************************/
  73 static int  Open   ( vlc_object_t * );
  74 static void Close  ( vlc_object_t * );
  75
  76 static void RunIntf( intf_thread_t *p_intf );
  77 static int GetOrientation( intf_thread_t *p_intf );
  78
  79 #define USE_ROTATE_TEXT N_("Use the rotate video filter instead of transform")
  80
  81 /*****************************************************************************
  82  * Module descriptor
  83  *****************************************************************************/
  84 vlc_module_begin ()
  85     set_shortname( N_("motion"))
  86     set_category( CAT_INTERFACE )
  87     set_subcategory( SUBCAT_INTERFACE_CONTROL )
  88     set_description( N_("motion control interface") )
  89     set_help( N_("Use HDAPS, AMS, APPLESMC or UNIMOTION motion sensors " \
  90                  "to rotate the video") )
  91
  92     add_bool( "motion-use-rotate", false,
  93               USE_ROTATE_TEXT, USE_ROTATE_TEXT, false )
  94
  95     set_capability( "interface", 0 )
  96     set_callbacks( Open, Close )
  97 vlc_module_end ()
  98
  99 /*****************************************************************************
 100  * OpenIntf: initialise interface
 101  *****************************************************************************/
 102 int Open ( vlc_object_t *p_this )
 103 {
 104     intf_thread_t *p_intf = (intf_thread_t *)p_this;
 105     FILE *f;
 106     int i_x = 0, i_y = 0;
 107
 108     p_intf->p_sys = malloc( sizeof( intf_sys_t ) );
 109     if( p_intf->p_sys == NULL )
 110     {
 111         return VLC_ENOMEM;
 112     }
 113
 114     if( access( "/sys/devices/platform/hdaps/position", R_OK ) == 0 )
 115     {
 116         /* IBM HDAPS support */
 117         f = fopen( "/sys/devices/platform/hdaps/calibrate", "r" );
 118         if( f )
 119         {
 120             p_intf->p_sys->i_calibrate = fscanf( f, "(%d,%d)", &i_x, &i_y ) == 2 ? i_x: 0;
 121             fclose( f );
 122             p_intf->p_sys->sensor = HDAPS_SENSOR;
 123         }
 124         else
 125         {
 126             p_intf->p_sys->sensor = NO_SENSOR;
 127         }
 128     }
 129     else if( access( "/sys/devices/ams/x", R_OK ) == 0 )
 130     {
 131         /* Apple Motion Sensor support */
 132         p_intf->p_sys->sensor = AMS_SENSOR;
 133     }
 134     else if( access( "/sys/devices/applesmc.768/position", R_OK ) == 0 )
 135     {
 136         /* Apple SMC (newer macbooks) */
 137         /* Should be factorised with HDAPS */
 138         f = fopen( "/sys/devices/applesmc.768/calibrate", "r" );
 139         if( f )
 140         {
 141             p_intf->p_sys->i_calibrate = fscanf( f, "(%d,%d)", &i_x, &i_y ) == 2 ? i_x: 0;
 142             fclose( f );
 143             p_intf->p_sys->sensor = APPLESMC_SENSOR;
 144         }
 145         else
 146         {
 147             p_intf->p_sys->sensor = NO_SENSOR;
 148         }
 149     }
 150 #ifdef HAVE_MACOS_UNIMOTION
 151     else if( (p_intf->p_sys->unimotion_hw = detect_sms()) )
 152         p_intf->p_sys->sensor = UNIMOTION_SENSOR;
 153 #endif
 154     else
 155     {
 156         /* No motion sensor support */
 157         p_intf->p_sys->sensor = NO_SENSOR;
 158     }
 159
 160     p_intf->pf_run = RunIntf;
 161
 162     p_intf->p_sys->b_use_rotate = var_InheritBool( p_intf, "motion-use-rotate" );
 163
 164     msg_Dbg( p_intf, "Motion detection correctly loaded" );
 165     return VLC_SUCCESS;
 166 }
 167
 168 /*****************************************************************************
 169  * CloseIntf: destroy interface
 170  *****************************************************************************/
 171 void Close ( vlc_object_t *p_this )
 172 {
 173     intf_thread_t *p_intf = (intf_thread_t *)p_this;
 174
 175     free( p_intf->p_sys );
 176 }
 177
 178 /*****************************************************************************
 179  * RunIntf: main loop
 180  *****************************************************************************/
 181 #define FILTER_LENGTH 16
 182 #define LOW_THRESHOLD 800
 183 #define HIGH_THRESHOLD 1000
 184 static void RunIntf( intf_thread_t *p_intf )
 185 {
 186     int i_x, i_oldx = 0, i_sum = 0, i = 0;
 187     int p_oldx[FILTER_LENGTH];
 188     memset( p_oldx, 0, FILTER_LENGTH * sizeof( int ) );
 189
 190     for( ;; )
 191     {
 192         vout_thread_t *p_vout;
 193         const char *psz_filter, *psz_type;
 194         bool b_change = false;
 195
 196         /* Wait a bit, get orientation, change filter if necessary */
 197         msleep( INTF_IDLE_SLEEP );
 198
 199         int canc = vlc_savecancel();
 200         i_x = GetOrientation( p_intf );
 201         i_sum += i_x - p_oldx[i];
 202         p_oldx[i++] = i_x;
 203         if( i == FILTER_LENGTH ) i = 0;
 204         i_x = i_sum / FILTER_LENGTH;
 205
 206         if( p_intf->p_sys->b_use_rotate )
 207         {
 208             if( i_oldx != i_x )
 209             {
 210                 /* TODO: cache object pointer */
 211                 vlc_object_t *p_obj =
 212                 vlc_object_find_name( p_intf->p_libvlc, "rotate", FIND_CHILD );
 213                 if( p_obj )
 214                 {
 215                     var_SetInteger( p_obj, "rotate-deciangle",
 216                             ((3600+i_x/2)%3600) );
 217                     i_oldx = i_x;
 218                     vlc_object_release( p_obj );
 219                 }
 220             }
 221             goto loop;
 222         }
 223
 224         if( i_x < -HIGH_THRESHOLD && i_oldx > -LOW_THRESHOLD )
 225         {
 226             b_change = true;
 227             psz_filter = "transform";
 228             psz_type = "270";
 229         }
 230         else if( ( i_x > -LOW_THRESHOLD && i_oldx < -HIGH_THRESHOLD )
 231                  || ( i_x < LOW_THRESHOLD && i_oldx > HIGH_THRESHOLD ) )
 232         {
 233             b_change = true;
 234             psz_filter = "";
 235             psz_type = "";
 236         }
 237         else if( i_x > HIGH_THRESHOLD && i_oldx < LOW_THRESHOLD )
 238         {
 239             b_change = true;
 240             psz_filter = "transform";
 241             psz_type = "90";
 242         }
 243
 244         if( b_change )
 245         {
 246             p_vout = (vout_thread_t *)
 247                 vlc_object_find( p_intf, VLC_OBJECT_VOUT, FIND_ANYWHERE );
 248             if( p_vout )
 249             {
 250                 config_PutPsz( p_vout, "transform-type", psz_type );
 251                 var_SetString( p_vout, "video-filter", psz_filter );
 252                 vlc_object_release( p_vout );
 253
 254                 i_oldx = i_x;
 255             }
 256         }
 257 loop:
 258         vlc_restorecancel( canc );
 259     }
 260 }
 261 #undef FILTER_LENGTH
 262 #undef LOW_THRESHOLD
 263 #undef HIGH_THRESHOLD
 264
 265 /*****************************************************************************
 266  * GetOrientation: get laptop orientation, range -1800 / +1800
 267  *****************************************************************************/
 268 static int GetOrientation( intf_thread_t *p_intf )
 269 {
 270     FILE *f;
 271     int i_x = 0, i_y = 0, i_z = 0;
 272     int i_ret;
 273
 274     switch( p_intf->p_sys->sensor )
 275     {
 276     case HDAPS_SENSOR:
 277         f = fopen( "/sys/devices/platform/hdaps/position", "r" );
 278         if( !f )
 279         {
 280             return 0;
 281         }
 282
 283         i_ret = fscanf( f, "(%d,%d)", &i_x, &i_y );
 284         fclose( f );
 285
 286         if( i_ret < 2 )
 287             return 0;
 288         else
 289             return ( i_x - p_intf->p_sys->i_calibrate ) * 10;
 290
 291     case AMS_SENSOR:
 292         f = fopen( "/sys/devices/ams/x", "r" );
 293         if( !f )
 294         {
 295             return 0;
 296         }
 297
 298         i_ret = fscanf( f, "%d", &i_x);
 299         fclose( f );
 300
 301         if( i_ret < 1 )
 302             return 0;
 303         else
 304             return - i_x * 30; /* FIXME: arbitrary */
 305
 306     case APPLESMC_SENSOR:
 307         f = fopen( "/sys/devices/applesmc.768/position", "r" );
 308         if( !f )
 309         {
 310             return 0;
 311         }
 312
 313         i_ret = fscanf( f, "(%d,%d,%d)", &i_x, &i_y, &i_z );
 314         fclose( f );
 315
 316         if( i_ret < 3 )
 317             return 0;
 318         else
 319             return ( i_x - p_intf->p_sys->i_calibrate ) * 10;
 320
 321 #ifdef HAVE_MACOS_UNIMOTION
 322     case UNIMOTION_SENSOR:
 323         if( read_sms_raw( p_intf->p_sys->unimotion_hw, &i_x, &i_y, &i_z ) )
 324         {
 325             double d_norm = sqrt( i_x*i_x+i_z*i_z );
 326             if( d_norm < 100 )
 327                 return 0;
 328             double d_x = i_x / d_norm;
 329             if( i_z > 0 )
 330                 return -asin(d_x)*3600/3.141;
 331             else
 332                 return 3600 + asin(d_x)*3600/3.141;
 333         }
 334         else
 335             return 0;
 336 #endif
 337     case NO_SENSOR:
 338     default:
 339         return 0;
 340     }
 341 }
 342