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 *****************************************************************************/
35 #include <vlc_common.h>
36 #include <vlc_plugin.h>
37 #include <vlc_interface.h>
45 #include "unimotion.h"
48 /*****************************************************************************
49 * intf_sys_t: description and status of interface
50 *****************************************************************************/
53 enum { NO_SENSOR
, HDAPS_SENSOR
, AMS_SENSOR
, APPLESMC_SENSOR
,
54 UNIMOTION_SENSOR
} sensor
;
56 enum sms_hardware unimotion_hw
;
63 /*****************************************************************************
65 *****************************************************************************/
66 static int Open ( vlc_object_t
* );
67 static void Close ( vlc_object_t
* );
69 static void RunIntf( intf_thread_t
*p_intf
);
70 static int GetOrientation( intf_thread_t
*p_intf
);
72 #define USE_ROTATE_TEXT N_("Use the rotate video filter instead of transform")
74 /*****************************************************************************
76 *****************************************************************************/
78 set_shortname( N_("motion"))
79 set_category( CAT_INTERFACE
)
80 set_subcategory( SUBCAT_INTERFACE_CONTROL
)
81 set_description( N_("motion control interface") )
82 set_help( N_("Use HDAPS, AMS, APPLESMC or UNIMOTION motion sensors " \
83 "to rotate the video") )
85 add_bool( "motion-use-rotate", false, NULL
,
86 USE_ROTATE_TEXT
, USE_ROTATE_TEXT
, false )
88 set_capability( "interface", 0 )
89 set_callbacks( Open
, Close
)
92 /*****************************************************************************
93 * OpenIntf: initialise interface
94 *****************************************************************************/
95 int Open ( vlc_object_t
*p_this
)
97 intf_thread_t
*p_intf
= (intf_thread_t
*)p_this
;
101 p_intf
->p_sys
= malloc( sizeof( intf_sys_t
) );
102 if( p_intf
->p_sys
== NULL
)
107 if( access( "/sys/devices/platform/hdaps/position", R_OK
) == 0 )
109 /* IBM HDAPS support */
110 f
= fopen( "/sys/devices/platform/hdaps/calibrate", "r" );
114 fscanf( f
, "(%d,%d)", &i_x
, &i_y
);
116 p_intf
->p_sys
->i_calibrate
= i_x
;
117 p_intf
->p_sys
->sensor
= HDAPS_SENSOR
;
121 p_intf
->p_sys
->sensor
= NO_SENSOR
;
124 else if( access( "/sys/devices/ams/x", R_OK
) == 0 )
126 /* Apple Motion Sensor support */
127 p_intf
->p_sys
->sensor
= AMS_SENSOR
;
129 else if( access( "/sys/devices/applesmc.768/position", R_OK
) == 0 )
131 /* Apple SMC (newer macbooks) */
132 /* Should be factorised with HDAPS */
133 f
= fopen( "/sys/devices/applesmc.768/calibrate", "r" );
137 fscanf( f
, "(%d,%d)", &i_x
, &i_y
);
139 p_intf
->p_sys
->i_calibrate
= i_x
;
140 p_intf
->p_sys
->sensor
= APPLESMC_SENSOR
;
144 p_intf
->p_sys
->sensor
= NO_SENSOR
;
148 else if((p_intf
->p_sys
->unimotion_hw
= detect_sms()))
149 p_intf
->p_sys
->sensor
= UNIMOTION_SENSOR
;
153 /* No motion sensor support */
154 p_intf
->p_sys
->sensor
= NO_SENSOR
;
157 p_intf
->pf_run
= RunIntf
;
159 p_intf
->p_sys
->b_use_rotate
=
160 var_InheritBool( p_intf
, "motion-use-rotate" );
165 /*****************************************************************************
166 * CloseIntf: destroy interface
167 *****************************************************************************/
168 void Close ( vlc_object_t
*p_this
)
170 intf_thread_t
*p_intf
= (intf_thread_t
*)p_this
;
172 free( p_intf
->p_sys
);
175 /*****************************************************************************
177 *****************************************************************************/
178 #define FILTER_LENGTH 16
179 #define LOW_THRESHOLD 800
180 #define HIGH_THRESHOLD 1000
181 static void RunIntf( intf_thread_t
*p_intf
)
183 int i_x
, i_oldx
= 0, i_sum
= 0, i
= 0;
184 int p_oldx
[FILTER_LENGTH
];
185 memset( p_oldx
, 0, FILTER_LENGTH
* sizeof( int ) );
189 vout_thread_t
*p_vout
;
190 const char *psz_filter
, *psz_type
;
191 bool b_change
= false;
193 /* Wait a bit, get orientation, change filter if necessary */
194 msleep( INTF_IDLE_SLEEP
);
196 int canc
= vlc_savecancel();
197 i_x
= GetOrientation( p_intf
);
198 i_sum
+= i_x
- p_oldx
[i
];
200 if( i
== FILTER_LENGTH
) i
= 0;
201 i_x
= i_sum
/ FILTER_LENGTH
;
203 if( p_intf
->p_sys
->b_use_rotate
)
207 /* TODO: cache object pointer */
208 vlc_object_t
*p_obj
=
209 vlc_object_find_name( p_intf
->p_libvlc
, "rotate", FIND_CHILD
);
212 var_SetInteger( p_obj
, "rotate-deciangle",
213 ((3600+i_x
/2)%3600) );
215 vlc_object_release( p_obj
);
221 if( i_x
< -HIGH_THRESHOLD
&& i_oldx
> -LOW_THRESHOLD
)
224 psz_filter
= "transform";
227 else if( ( i_x
> -LOW_THRESHOLD
&& i_oldx
< -HIGH_THRESHOLD
)
228 || ( i_x
< LOW_THRESHOLD
&& i_oldx
> HIGH_THRESHOLD
) )
234 else if( i_x
> HIGH_THRESHOLD
&& i_oldx
< LOW_THRESHOLD
)
237 psz_filter
= "transform";
243 p_vout
= (vout_thread_t
*)
244 vlc_object_find( p_intf
, VLC_OBJECT_VOUT
, FIND_ANYWHERE
);
247 config_PutPsz( p_vout
, "transform-type", psz_type
);
248 var_SetString( p_vout
, "vout-filter", psz_filter
);
249 vlc_object_release( p_vout
);
255 vlc_restorecancel( canc
);
260 #undef HIGH_THRESHOLD
262 /*****************************************************************************
263 * GetOrientation: get laptop orientation, range -1800 / +1800
264 *****************************************************************************/
265 static int GetOrientation( intf_thread_t
*p_intf
)
268 int i_x
, i_y
, i_z
= 0;
270 switch( p_intf
->p_sys
->sensor
)
273 f
= fopen( "/sys/devices/platform/hdaps/position", "r" );
280 fscanf( f
, "(%d,%d)", &i_x
, &i_y
);
283 return ( i_x
- p_intf
->p_sys
->i_calibrate
) * 10;
286 f
= fopen( "/sys/devices/ams/x", "r" );
292 fscanf( f
, "%d", &i_x
);
295 return - i_x
* 30; /* FIXME: arbitrary */
297 case APPLESMC_SENSOR
:
298 f
= fopen( "/sys/devices/applesmc.768/position", "r" );
305 fscanf( f
, "(%d,%d,%d)", &i_x
, &i_y
, &i_z
);
308 return ( i_x
- p_intf
->p_sys
->i_calibrate
) * 10;
311 case UNIMOTION_SENSOR
:
312 if( read_sms_raw( p_intf
->p_sys
->unimotion_hw
, &i_x
, &i_y
, &i_z
) )
314 double d_norm
= sqrt( i_x
*i_x
+i_z
*i_z
);
317 double d_x
= i_x
/ d_norm
;
319 return -asin(d_x
)*3600/3.141;
321 return 3600 + asin(d_x
)*3600/3.141;