1 /*****************************************************************************
2 * motion.c: control VLC with laptop built-in motion sensors
3 *****************************************************************************
4 * Copyright (C) 2006 - 2007 the VideoLAN team
7 * Author: Sam Hocevar <sam@zoy.org>
8 * Jérôme Decoodt <djc@videolan.org> (unimotion integration)
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.
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.
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 *****************************************************************************/
25 /*****************************************************************************
27 *****************************************************************************/
34 #include <vlc_common.h>
35 #include <vlc_plugin.h>
36 #include <vlc_interface.h>
44 #include "unimotion.h"
47 /*****************************************************************************
48 * intf_sys_t: description and status of interface
49 *****************************************************************************/
52 enum { NO_SENSOR, HDAPS_SENSOR, AMS_SENSOR, APPLESMC_SENSOR,
53 UNIMOTION_SENSOR } sensor;
55 enum sms_hardware unimotion_hw;
62 /*****************************************************************************
64 *****************************************************************************/
65 static int Open ( vlc_object_t * );
66 static void Close ( vlc_object_t * );
68 static void RunIntf( intf_thread_t *p_intf );
69 static int GetOrientation( intf_thread_t *p_intf );
71 #define USE_ROTATE_TEXT N_("Use the rotate video filter instead of transform")
73 /*****************************************************************************
75 *****************************************************************************/
77 set_shortname( N_("motion"));
78 set_category( CAT_INTERFACE );
79 set_description( N_("motion control interface") );
80 set_help( N_("Use HDAPS, AMS, APPLESMC or UNIMOTION motion sensors " \
81 "to rotate the video") )
83 add_bool( "motion-use-rotate", 0, NULL,
84 USE_ROTATE_TEXT, USE_ROTATE_TEXT, false );
86 set_capability( "interface", 0 );
87 set_callbacks( Open, Close );
90 /*****************************************************************************
91 * OpenIntf: initialise interface
92 *****************************************************************************/
93 int Open ( vlc_object_t *p_this )
95 intf_thread_t *p_intf = (intf_thread_t *)p_this;
99 p_intf->p_sys = malloc( sizeof( intf_sys_t ) );
100 if( p_intf->p_sys == NULL )
105 if( access( "/sys/devices/platform/hdaps/position", R_OK ) == 0 )
107 /* IBM HDAPS support */
108 f = fopen( "/sys/devices/platform/hdaps/calibrate", "r" );
112 fscanf( f, "(%d,%d)", &i_x, &i_y );
114 p_intf->p_sys->i_calibrate = i_x;
115 p_intf->p_sys->sensor = HDAPS_SENSOR;
119 p_intf->p_sys->sensor = NO_SENSOR;
122 else if( access( "/sys/devices/ams/x", R_OK ) == 0 )
124 /* Apple Motion Sensor support */
125 p_intf->p_sys->sensor = AMS_SENSOR;
127 else if( access( "/sys/devices/applesmc.768/position", R_OK ) == 0 )
129 /* Apple SMC (newer macbooks) */
130 /* Should be factorised with HDAPS */
131 f = fopen( "/sys/devices/applesmc.768/calibrate", "r" );
135 fscanf( f, "(%d,%d)", &i_x, &i_y );
137 p_intf->p_sys->i_calibrate = i_x;
138 p_intf->p_sys->sensor = APPLESMC_SENSOR;
142 p_intf->p_sys->sensor = NO_SENSOR;
146 else if( p_intf->p_sys->unimotion_hw = detect_sms() )
147 p_intf->p_sys->sensor = UNIMOTION_SENSOR;
151 /* No motion sensor support */
152 p_intf->p_sys->sensor = NO_SENSOR;
155 p_intf->pf_run = RunIntf;
157 p_intf->p_sys->b_use_rotate = config_GetInt( p_intf, "motion-use-rotate" );
162 /*****************************************************************************
163 * CloseIntf: destroy interface
164 *****************************************************************************/
165 void Close ( vlc_object_t *p_this )
167 intf_thread_t *p_intf = (intf_thread_t *)p_this;
169 free( p_intf->p_sys );
172 /*****************************************************************************
174 *****************************************************************************/
175 #define FILTER_LENGTH 16
176 #define LOW_THRESHOLD 800
177 #define HIGH_THRESHOLD 1000
178 static void RunIntf( intf_thread_t *p_intf )
180 int i_x, i_oldx = 0, i_sum = 0, i = 0;
181 int p_oldx[FILTER_LENGTH];
182 memset( p_oldx, 0, FILTER_LENGTH * sizeof( int ) );
184 while( !intf_ShouldDie( p_intf ) )
186 vout_thread_t *p_vout;
187 const char *psz_filter, *psz_type;
188 bool b_change = false;
190 /* Wait a bit, get orientation, change filter if necessary */
191 msleep( INTF_IDLE_SLEEP );
193 i_x = GetOrientation( p_intf );
194 i_sum += i_x - p_oldx[i];
196 if( i == FILTER_LENGTH ) i = 0;
197 i_x = i_sum / FILTER_LENGTH;
199 if( p_intf->p_sys->b_use_rotate )
203 /* TODO: cache object pointer */
204 vlc_object_t *p_obj =
205 vlc_object_find_name( p_intf->p_libvlc, "rotate", FIND_CHILD );
208 var_SetInteger( p_obj, "rotate-deciangle",
209 ((3600+i_x/2)%3600) );
211 vlc_object_release( p_obj );
217 if( i_x < -HIGH_THRESHOLD && i_oldx > -LOW_THRESHOLD )
220 psz_filter = "transform";
223 else if( ( i_x > -LOW_THRESHOLD && i_oldx < -HIGH_THRESHOLD )
224 || ( i_x < LOW_THRESHOLD && i_oldx > HIGH_THRESHOLD ) )
230 else if( i_x > HIGH_THRESHOLD && i_oldx < LOW_THRESHOLD )
233 psz_filter = "transform";
242 p_vout = (vout_thread_t *)
243 vlc_object_find( p_intf, VLC_OBJECT_VOUT, FIND_ANYWHERE );
249 config_PutPsz( p_vout, "transform-type", psz_type );
250 var_SetString( p_vout, "vout-filter", psz_filter );
251 vlc_object_release( p_vout );
258 #undef HIGH_THRESHOLD
260 /*****************************************************************************
261 * GetOrientation: get laptop orientation, range -1800 / +1800
262 *****************************************************************************/
263 static int GetOrientation( intf_thread_t *p_intf )
266 int i_x, i_y, i_z = 0;
268 switch( p_intf->p_sys->sensor )
271 f = fopen( "/sys/devices/platform/hdaps/position", "r" );
278 fscanf( f, "(%d,%d)", &i_x, &i_y );
281 return ( i_x - p_intf->p_sys->i_calibrate ) * 10;
284 f = fopen( "/sys/devices/ams/x", "r" );
290 fscanf( f, "%d", &i_x);
293 return - i_x * 30; /* FIXME: arbitrary */
295 case APPLESMC_SENSOR:
296 f = fopen( "/sys/devices/applesmc.768/position", "r" );
303 fscanf( f, "(%d,%d,%d)", &i_x, &i_y, &i_z );
306 return ( i_x - p_intf->p_sys->i_calibrate ) * 10;
309 case UNIMOTION_SENSOR:
310 if( read_sms_raw( p_intf->p_sys->unimotion_hw, &i_x, &i_y, &i_z ) )
312 double d_norm = sqrt( i_x*i_x+i_z*i_z );
315 double d_x = i_x / d_norm;
317 return -asin(d_x)*3600/3.141;
319 return 3600 + asin(d_x)*3600/3.141;