/*****************************************************************************
* motion.c: control VLC with laptop built-in motion sensors
*****************************************************************************
- * Copyright (C) 2006 the VideoLAN team
+ * Copyright (C) 2006 - 2007 the VideoLAN team
* $Id$
*
* Author: Sam Hocevar <sam@zoy.org>
+ * Jérôme Decoodt <djc@videolan.org> (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
/*****************************************************************************
* Preamble
*****************************************************************************/
-#include <stdlib.h> /* malloc(), free() */
-#include <string.h>
-#include <vlc/vlc.h>
-#include <vlc/intf.h>
-#include <vlc/vout.h>
+#ifdef HAVE_CONFIG_H
+# include "config.h"
+#endif
+
+#include <math.h>
+#include <unistd.h>
+
+#include <vlc_common.h>
+#include <vlc_plugin.h>
+#include <vlc_interface.h>
+#include <vlc_playlist.h>
+#include <vlc_vout.h>
-#ifdef HAVE_UNISTD_H
-# include <unistd.h>
+#ifdef __APPLE__
+# include "TargetConditionals.h"
+# if !TARGET_OS_IPHONE
+# define HAVE_MACOS_UNIMOTION
+# endif
+#endif
+
+#ifdef HAVE_MACOS_UNIMOTION
+# include "unimotion.h"
#endif
/*****************************************************************************
*****************************************************************************/
struct intf_sys_t
{
- enum { NO_SENSOR, HDAPS_SENSOR, AMS_SENSOR } sensor;
+ enum { NO_SENSOR, HDAPS_SENSOR, AMS_SENSOR, APPLESMC_SENSOR,
+ UNIMOTION_SENSOR } sensor;
+#ifdef HAVE_MACOS_UNIMOTION
+ enum sms_hardware unimotion_hw;
+#endif
+ int i_calibrate;
- int i_last_x, i_calibrate;
- int i_threshold;
+ bool b_use_rotate;
};
/*****************************************************************************
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") );
+vlc_module_begin ()
+ set_shortname( N_("motion"))
+ set_category( CAT_INTERFACE )
+ set_subcategory( SUBCAT_INTERFACE_CONTROL )
+ set_description( N_("motion control interface") )
+ set_help( N_("Use HDAPS, AMS, APPLESMC or UNIMOTION motion sensors " \
+ "to rotate the video") )
+
+ add_bool( "motion-use-rotate", false,
+ USE_ROTATE_TEXT, USE_ROTATE_TEXT, false )
- set_capability( "interface", 0 );
- set_callbacks( Open, Close );
-vlc_module_end();
+ set_capability( "interface", 0 )
+ set_callbacks( Open, Close )
+vlc_module_end ()
/*****************************************************************************
* OpenIntf: initialise interface
{
intf_thread_t *p_intf = (intf_thread_t *)p_this;
FILE *f;
- int i_x, i_y;
+ int i_x = 0, i_y = 0;
p_intf->p_sys = malloc( sizeof( intf_sys_t ) );
if( p_intf->p_sys == NULL )
f = fopen( "/sys/devices/platform/hdaps/calibrate", "r" );
if( f )
{
- i_x = i_y = 0;
- fscanf( f, "(%d,%d)", &i_x, &i_y );
+ p_intf->p_sys->i_calibrate = fscanf( f, "(%d,%d)", &i_x, &i_y ) == 2 ? i_x: 0;
fclose( f );
- p_intf->p_sys->i_calibrate = i_x;
p_intf->p_sys->sensor = HDAPS_SENSOR;
}
else
/* Apple Motion Sensor support */
p_intf->p_sys->sensor = AMS_SENSOR;
}
+ else if( access( "/sys/devices/applesmc.768/position", R_OK ) == 0 )
+ {
+ /* Apple SMC (newer macbooks) */
+ /* Should be factorised with HDAPS */
+ f = fopen( "/sys/devices/applesmc.768/calibrate", "r" );
+ if( f )
+ {
+ p_intf->p_sys->i_calibrate = fscanf( f, "(%d,%d)", &i_x, &i_y ) == 2 ? i_x: 0;
+ fclose( f );
+ p_intf->p_sys->sensor = APPLESMC_SENSOR;
+ }
+ else
+ {
+ p_intf->p_sys->sensor = NO_SENSOR;
+ }
+ }
+#ifdef HAVE_MACOS_UNIMOTION
+ 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->pf_run = RunIntf;
+ p_intf->p_sys->b_use_rotate = var_InheritBool( p_intf, "motion-use-rotate" );
+
+ msg_Dbg( p_intf, "Motion detection correctly loaded" );
return VLC_SUCCESS;
}
/*****************************************************************************
* 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;
+ 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 ) )
+ for( ;; )
{
-#define LOW_THRESHOLD 80
-#define HIGH_THRESHOLD 100
- vout_thread_t *p_vout;
- char *psz_filter, *psz_type;
- vlc_bool_t b_change = VLC_FALSE;
+ const char *psz_filter, *psz_type;
+ bool b_change = false;
/* Wait a bit, get orientation, change filter if necessary */
+#warning FIXME: check once (or less) per picture, not once per interval
msleep( INTF_IDLE_SLEEP );
+ int canc = vlc_savecancel();
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" );
+ if( p_obj )
+ {
+ var_SetInteger( p_obj, "rotate-deciangle",
+ ((3600+i_x/2)%3600) );
+ i_oldx = i_x;
+ vlc_object_release( p_obj );
+ }
+ }
+ goto loop;
+ }
if( i_x < -HIGH_THRESHOLD && i_oldx > -LOW_THRESHOLD )
{
- b_change = VLC_TRUE;
+ b_change = 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;
+ b_change = true;
psz_filter = "";
psz_type = "";
}
else if( i_x > HIGH_THRESHOLD && i_oldx < LOW_THRESHOLD )
{
- b_change = VLC_TRUE;
+ b_change = true;
psz_filter = "transform";
psz_type = "90";
}
- if( !b_change )
+ if( b_change )
{
- continue;
+#warning FIXME: refactor this plugin as a video filter!
+ input_thread_t *p_input;
+
+ p_input = playlist_CurrentInput( pl_Get( p_intf ) );
+ if( p_input )
+ {
+ vout_thread_t *p_vout;
+
+ p_vout = input_GetVout( p_input );
+ if( p_vout )
+ {
+#warning FIXME: do not override the permanent configuration!
+#warning FIXME: transform-type does not exist anymore
+ config_PutPsz( p_vout, "transform-type", psz_type );
+ var_SetString( p_vout, "video-filter", psz_filter );
+ vlc_object_release( p_vout );
+ }
+ vlc_object_release( p_input );
+ i_oldx = i_x;
+ }
}
-
- 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;
+loop:
+ vlc_restorecancel( canc );
}
}
+#undef FILTER_LENGTH
+#undef LOW_THRESHOLD
+#undef HIGH_THRESHOLD
/*****************************************************************************
- * GetOrientation: get laptop orientation, range -180 / +180
+ * GetOrientation: get laptop orientation, range -1800 / +1800
*****************************************************************************/
static int GetOrientation( intf_thread_t *p_intf )
{
FILE *f;
- int i_x, i_y;
+ int i_x = 0, i_y = 0, i_z = 0;
+ int i_ret;
switch( p_intf->p_sys->sensor )
{
return 0;
}
- i_x = i_y = 0;
- fscanf( f, "(%d,%d)", &i_x, &i_y );
+ i_ret = fscanf( f, "(%d,%d)", &i_x, &i_y );
fclose( f );
- return i_x - p_intf->p_sys->i_calibrate;
+ if( i_ret < 2 )
+ return 0;
+ else
+ return ( i_x - p_intf->p_sys->i_calibrate ) * 10;
case AMS_SENSOR:
f = fopen( "/sys/devices/ams/x", "r" );
return 0;
}
- fscanf( f, "%d", &i_x);
+ i_ret = fscanf( f, "%d", &i_x);
fclose( f );
- return - i_x * 3; /* FIXME: arbitrary */
+ if( i_ret < 1 )
+ return 0;
+ else
+ return - i_x * 30; /* FIXME: arbitrary */
+ case APPLESMC_SENSOR:
+ f = fopen( "/sys/devices/applesmc.768/position", "r" );
+ if( !f )
+ {
+ return 0;
+ }
+
+ i_ret = fscanf( f, "(%d,%d,%d)", &i_x, &i_y, &i_z );
+ fclose( f );
+
+ if( i_ret < 3 )
+ return 0;
+ else
+ return ( i_x - p_intf->p_sys->i_calibrate ) * 10;
+
+#ifdef HAVE_MACOS_UNIMOTION
+ 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
+ case NO_SENSOR:
default:
return 0;
}
projects / vlc / blobdiff