/***************************************************************************** * motion.c: control VLC with laptop built-in motion sensors ***************************************************************************** * Copyright (C) 2006 - 2007 the VideoLAN team * $Id$ * * Author: Sam Hocevar * Jérôme Decoodt (unimotion integration) * * This program is free software; you can redistribute it and/or modify * it under the terms of the GNU General Public License as published by * the Free Software Foundation; either version 2 of the License, or * (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston MA 02110-1301, USA. *****************************************************************************/ /***************************************************************************** * Preamble *****************************************************************************/ #include #ifdef HAVE_CONFIG_H # include "config.h" #endif #include #include #include #ifdef HAVE_UNISTD_H # include #endif #ifdef __APPLE__ #include "unimotion.h" #endif /***************************************************************************** * intf_sys_t: description and status of interface *****************************************************************************/ struct intf_sys_t { enum { NO_SENSOR, HDAPS_SENSOR, AMS_SENSOR, UNIMOTION_SENSOR } sensor; #ifdef __APPLE__ enum sms_hardware unimotion_hw; #endif int i_calibrate; vlc_bool_t b_use_rotate; }; /***************************************************************************** * Local prototypes. *****************************************************************************/ static int Open ( vlc_object_t * ); static void Close ( vlc_object_t * ); static void RunIntf( intf_thread_t *p_intf ); static int GetOrientation( intf_thread_t *p_intf ); #define USE_ROTATE_TEXT N_("Use the rotate video filter instead of transform") /***************************************************************************** * Module descriptor *****************************************************************************/ vlc_module_begin(); set_shortname( _("motion")); set_category( CAT_INTERFACE ); set_description( _("motion control interface") ); add_bool( "motion-use-rotate", 0, NULL, USE_ROTATE_TEXT, USE_ROTATE_TEXT, VLC_FALSE ); set_capability( "interface", 0 ); set_callbacks( Open, Close ); vlc_module_end(); /***************************************************************************** * OpenIntf: initialise interface *****************************************************************************/ int Open ( vlc_object_t *p_this ) { intf_thread_t *p_intf = (intf_thread_t *)p_this; FILE *f; int i_x, i_y; p_intf->p_sys = malloc( sizeof( intf_sys_t ) ); if( p_intf->p_sys == NULL ) { return VLC_ENOMEM; } if( access( "/sys/devices/platform/hdaps/position", R_OK ) == 0 ) { /* IBM HDAPS support */ f = fopen( "/sys/devices/platform/hdaps/calibrate", "r" ); if( f ) { i_x = i_y = 0; fscanf( f, "(%d,%d)", &i_x, &i_y ); fclose( f ); p_intf->p_sys->i_calibrate = i_x; p_intf->p_sys->sensor = HDAPS_SENSOR; } else { p_intf->p_sys->sensor = NO_SENSOR; } } else if( access( "/sys/devices/ams/x", R_OK ) == 0 ) { /* Apple Motion Sensor support */ p_intf->p_sys->sensor = AMS_SENSOR; } #ifdef __APPLE__ else if( p_intf->p_sys->unimotion_hw = detect_sms() ) p_intf->p_sys->sensor = UNIMOTION_SENSOR; #endif else { /* No motion sensor support */ p_intf->p_sys->sensor = NO_SENSOR; } p_intf->pf_run = RunIntf; p_intf->p_sys->b_use_rotate = config_GetInt( p_intf, "motion-use-rotate" ); return VLC_SUCCESS; } /***************************************************************************** * CloseIntf: destroy interface *****************************************************************************/ void Close ( vlc_object_t *p_this ) { intf_thread_t *p_intf = (intf_thread_t *)p_this; free( p_intf->p_sys ); } /***************************************************************************** * RunIntf: main loop *****************************************************************************/ #define FILTER_LENGTH 16 #define LOW_THRESHOLD 800 #define HIGH_THRESHOLD 1000 static void RunIntf( intf_thread_t *p_intf ) { int i_x, i_oldx = 0, i_sum = 0, i = 0; int p_oldx[FILTER_LENGTH]; memset( p_oldx, 0, FILTER_LENGTH * sizeof( int ) ); while( !intf_ShouldDie( p_intf ) ) { vout_thread_t *p_vout; const char *psz_filter, *psz_type; vlc_bool_t b_change = VLC_FALSE; /* Wait a bit, get orientation, change filter if necessary */ msleep( INTF_IDLE_SLEEP ); i_x = GetOrientation( p_intf ); i_sum += i_x - p_oldx[i]; p_oldx[i++] = i_x; if( i == FILTER_LENGTH ) i = 0; i_x = i_sum / FILTER_LENGTH; if( p_intf->p_sys->b_use_rotate ) { if( i_oldx != i_x ) { /* TODO: cache object pointer */ vlc_object_t *p_obj = vlc_object_find_name( p_intf->p_libvlc, "rotate", FIND_CHILD ); if( p_obj ) { var_SetInteger( p_obj, "rotate-deciangle", ((3600+i_x/2)%3600) ); i_oldx = i_x; vlc_object_release( p_obj ); } } continue; } if( i_x < -HIGH_THRESHOLD && i_oldx > -LOW_THRESHOLD ) { b_change = VLC_TRUE; psz_filter = "transform"; psz_type = "270"; } else if( ( i_x > -LOW_THRESHOLD && i_oldx < -HIGH_THRESHOLD ) || ( i_x < LOW_THRESHOLD && i_oldx > HIGH_THRESHOLD ) ) { b_change = VLC_TRUE; psz_filter = ""; psz_type = ""; } else if( i_x > HIGH_THRESHOLD && i_oldx < LOW_THRESHOLD ) { b_change = VLC_TRUE; psz_filter = "transform"; psz_type = "90"; } if( !b_change ) { continue; } p_vout = (vout_thread_t *) vlc_object_find( p_intf, VLC_OBJECT_VOUT, FIND_ANYWHERE ); if( !p_vout ) { continue; } config_PutPsz( p_vout, "transform-type", psz_type ); var_SetString( p_vout, "vout-filter", psz_filter ); vlc_object_release( p_vout ); i_oldx = i_x; } } #undef FILTER_LENGTH #undef LOW_THRESHOLD #undef HIGH_THRESHOLD /***************************************************************************** * GetOrientation: get laptop orientation, range -1800 / +1800 *****************************************************************************/ static int GetOrientation( intf_thread_t *p_intf ) { FILE *f; int i_x, i_y; #ifdef __APPLE__ int i_z; #endif switch( p_intf->p_sys->sensor ) { case HDAPS_SENSOR: f = fopen( "/sys/devices/platform/hdaps/position", "r" ); if( !f ) { return 0; } i_x = i_y = 0; fscanf( f, "(%d,%d)", &i_x, &i_y ); fclose( f ); return ( i_x - p_intf->p_sys->i_calibrate ) * 10; case AMS_SENSOR: f = fopen( "/sys/devices/ams/x", "r" ); if( !f ) { return 0; } fscanf( f, "%d", &i_x); fclose( f ); return - i_x * 30; /* FIXME: arbitrary */ #ifdef __APPLE__ case UNIMOTION_SENSOR: if( read_sms_raw( p_intf->p_sys->unimotion_hw, &i_x, &i_y, &i_z ) ) { double d_norm = sqrt( i_x*i_x+i_z*i_z ); if( d_norm < 100 ) return 0; double d_x = i_x / d_norm; if( i_z > 0 ) return -asin(d_x)*3600/3.141; else return 3600 + asin(d_x)*3600/3.141; } else return 0; #endif default: return 0; } }