Pierre Ynard
14 years ago
4 changed files with 268 additions and 153 deletions
@ -0,0 +1,223 @@ |
|||
/*****************************************************************************
|
|||
* motion.c: laptop built-in motion sensors |
|||
***************************************************************************** |
|||
* Copyright (C) 2006 - 2012 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 |
|||
* 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. |
|||
*****************************************************************************/ |
|||
|
|||
#ifdef HAVE_CONFIG_H |
|||
# include "config.h" |
|||
#endif |
|||
|
|||
#include <math.h> |
|||
#include <unistd.h> |
|||
|
|||
#include <vlc_common.h> |
|||
|
|||
#ifdef __APPLE__ |
|||
# include "TargetConditionals.h" |
|||
# if !TARGET_OS_IPHONE |
|||
# define HAVE_MACOS_UNIMOTION |
|||
# endif |
|||
#endif |
|||
|
|||
#ifdef HAVE_MACOS_UNIMOTION |
|||
# include "unimotion.h" |
|||
#endif |
|||
|
|||
#include "motionlib.h" |
|||
|
|||
struct motion_sensors_t |
|||
{ |
|||
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 p_oldx[16]; |
|||
int i; |
|||
int i_sum; |
|||
}; |
|||
|
|||
motion_sensors_t *motion_create( vlc_object_t *obj ) |
|||
{ |
|||
FILE *f; |
|||
int i_x = 0, i_y = 0; |
|||
|
|||
motion_sensors_t *motion = malloc( sizeof( motion_sensors_t ) ); |
|||
if( unlikely( motion == NULL ) ) |
|||
{ |
|||
return NULL; |
|||
} |
|||
|
|||
if( access( "/sys/devices/platform/hdaps/position", R_OK ) == 0 ) |
|||
{ |
|||
/* IBM HDAPS support */ |
|||
f = fopen( "/sys/devices/platform/hdaps/calibrate", "r" ); |
|||
if( f ) |
|||
{ |
|||
motion->i_calibrate = fscanf( f, "(%d,%d)", &i_x, &i_y ) == 2 ? i_x: 0; |
|||
fclose( f ); |
|||
motion->sensor = HDAPS_SENSOR; |
|||
} |
|||
else |
|||
{ |
|||
motion->sensor = NO_SENSOR; |
|||
} |
|||
} |
|||
else if( access( "/sys/devices/ams/x", R_OK ) == 0 ) |
|||
{ |
|||
/* Apple Motion Sensor support */ |
|||
motion->sensor = AMS_SENSOR; |
|||
} |
|||
else if( access( "/sys/devices/platform/applesmc.768/position", R_OK ) == 0 ) |
|||
{ |
|||
/* Apple SMC (newer macbooks) */ |
|||
/* Should be factorised with HDAPS */ |
|||
f = fopen( "/sys/devices/platform/applesmc.768/calibrate", "r" ); |
|||
if( f ) |
|||
{ |
|||
motion->i_calibrate = fscanf( f, "(%d,%d)", &i_x, &i_y ) == 2 ? i_x: 0; |
|||
fclose( f ); |
|||
motion->sensor = APPLESMC_SENSOR; |
|||
} |
|||
else |
|||
{ |
|||
motion->sensor = NO_SENSOR; |
|||
} |
|||
} |
|||
#ifdef HAVE_MACOS_UNIMOTION |
|||
else if( (motion->unimotion_hw = detect_sms()) ) |
|||
motion->sensor = UNIMOTION_SENSOR; |
|||
#endif |
|||
else |
|||
{ |
|||
/* No motion sensor support */ |
|||
motion->sensor = NO_SENSOR; |
|||
} |
|||
|
|||
memset( motion->p_oldx, 0, sizeof( motion->p_oldx ) ); |
|||
motion->i = 0; |
|||
motion->i_sum = 0; |
|||
msg_Dbg( obj, "Motion detection correctly loaded" ); |
|||
return motion; |
|||
} |
|||
|
|||
void motion_destroy( motion_sensors_t *motion ) |
|||
{ |
|||
free( motion ); |
|||
} |
|||
|
|||
/*****************************************************************************
|
|||
* GetOrientation: get laptop orientation, range -1800 / +1800 |
|||
*****************************************************************************/ |
|||
static int GetOrientation( motion_sensors_t *motion ) |
|||
{ |
|||
FILE *f; |
|||
int i_x = 0, i_y = 0, i_z = 0; |
|||
int i_ret; |
|||
|
|||
switch( motion->sensor ) |
|||
{ |
|||
case HDAPS_SENSOR: |
|||
f = fopen( "/sys/devices/platform/hdaps/position", "r" ); |
|||
if( !f ) |
|||
{ |
|||
return 0; |
|||
} |
|||
|
|||
i_ret = fscanf( f, "(%d,%d)", &i_x, &i_y ); |
|||
fclose( f ); |
|||
|
|||
if( i_ret < 2 ) |
|||
return 0; |
|||
else |
|||
return ( i_x - motion->i_calibrate ) * 10; |
|||
|
|||
case AMS_SENSOR: |
|||
f = fopen( "/sys/devices/ams/x", "r" ); |
|||
if( !f ) |
|||
{ |
|||
return 0; |
|||
} |
|||
|
|||
i_ret = fscanf( f, "%d", &i_x); |
|||
fclose( f ); |
|||
|
|||
if( i_ret < 1 ) |
|||
return 0; |
|||
else |
|||
return - i_x * 30; /* FIXME: arbitrary */ |
|||
|
|||
case APPLESMC_SENSOR: |
|||
f = fopen( "/sys/devices/platform/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 - motion->i_calibrate ) * 10; |
|||
|
|||
#ifdef HAVE_MACOS_UNIMOTION |
|||
case UNIMOTION_SENSOR: |
|||
if( read_sms_raw( motion->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; |
|||
} |
|||
} |
|||
|
|||
/*****************************************************************************
|
|||
* motion_get_angle: get averaged laptop orientation, range -1800 / +1800 |
|||
*****************************************************************************/ |
|||
int motion_get_angle( motion_sensors_t *motion ) |
|||
{ |
|||
const int filter_length = ARRAY_SIZE( motion->p_oldx ); |
|||
int i_x = GetOrientation( motion ); |
|||
|
|||
motion->i_sum += i_x - motion->p_oldx[motion->i]; |
|||
motion->p_oldx[motion->i] = i_x; |
|||
motion->i = ( motion->i + 1 ) % filter_length; |
|||
i_x = motion->i_sum / filter_length; |
|||
|
|||
return i_x; |
|||
} |
|||
|
|||
@ -0,0 +1,34 @@ |
|||
/*****************************************************************************
|
|||
* motion.h: laptop built-in motion sensors |
|||
***************************************************************************** |
|||
* Copyright (C) 2012 the VideoLAN team |
|||
* $Id$ |
|||
* |
|||
* Author: Pierre Ynard |
|||
* |
|||
* 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. |
|||
*****************************************************************************/ |
|||
|
|||
#ifndef MOTION_H |
|||
#define MOTION_H |
|||
|
|||
typedef struct motion_sensors_t motion_sensors_t; |
|||
|
|||
motion_sensors_t *motion_create( vlc_object_t *obj ); |
|||
void motion_destroy( motion_sensors_t *motion ); |
|||
int motion_get_angle( motion_sensors_t *motion ); |
|||
|
|||
#endif |
|||
|
|||
Loading…
Reference in new issue