motion.c 9.56 KB
Newer Older
1 2 3
/*****************************************************************************
 * motion.c: control VLC with laptop built-in motion sensors
 *****************************************************************************
4
 * Copyright (C) 2006 - 2007 the VideoLAN team
5 6 7
 * $Id$
 *
 * Author: Sam Hocevar <sam@zoy.org>
8
 *         Jérôme Decoodt <djc@videolan.org> (unimotion integration)
9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28
 *
 * 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
 *****************************************************************************/

29 30 31 32
#ifdef HAVE_CONFIG_H
# include "config.h"
#endif

33 34
#include <math.h>

35
#include <vlc_common.h>
36
#include <vlc_plugin.h>
Clément Stenac's avatar
Clément Stenac committed
37 38
#include <vlc_interface.h>
#include <vlc_vout.h>
39 40 41 42 43

#ifdef HAVE_UNISTD_H
#    include <unistd.h>
#endif

44 45 46 47
#ifdef __APPLE__
#include "unimotion.h"
#endif

48 49 50 51 52
/*****************************************************************************
 * intf_sys_t: description and status of interface
 *****************************************************************************/
struct intf_sys_t
{
53 54
    enum { NO_SENSOR, HDAPS_SENSOR, AMS_SENSOR, APPLESMC_SENSOR,
           UNIMOTION_SENSOR } sensor;
Jérome Decoodt's avatar
Jérome Decoodt committed
55
#ifdef __APPLE__
56
    enum sms_hardware unimotion_hw;
Jérome Decoodt's avatar
Jérome Decoodt committed
57
#endif
58 59
    int i_calibrate;

60
    bool b_use_rotate;
61 62 63 64 65 66 67 68 69 70 71
};

/*****************************************************************************
 * 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 );

72 73
#define USE_ROTATE_TEXT N_("Use the rotate video filter instead of transform")

74 75 76 77
/*****************************************************************************
 * Module descriptor
 *****************************************************************************/
vlc_module_begin();
78
    set_shortname( N_("motion"));
79
    set_category( CAT_INTERFACE );
80
    set_description( N_("motion control interface") );
81 82
    set_help( N_("Use HDAPS, AMS, APPLESMC or UNIMOTION motion sensors " \
                 "to rotate the video") )
83

84
    add_bool( "motion-use-rotate", 0, NULL,
85
              USE_ROTATE_TEXT, USE_ROTATE_TEXT, false );
86

87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127
    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;
    }
128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145
    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 )
        {
            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 = APPLESMC_SENSOR;
        }
        else
        {
            p_intf->p_sys->sensor = NO_SENSOR;
        }
    }
146 147 148 149
#ifdef __APPLE__
    else if( p_intf->p_sys->unimotion_hw = detect_sms() )
        p_intf->p_sys->sensor = UNIMOTION_SENSOR;
#endif
150 151 152 153 154 155 156 157
    else
    {
        /* No motion sensor support */
        p_intf->p_sys->sensor = NO_SENSOR;
    }

    p_intf->pf_run = RunIntf;

158 159
    p_intf->p_sys->b_use_rotate = config_GetInt( p_intf, "motion-use-rotate" );

160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175
    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
 *****************************************************************************/
176 177 178
#define FILTER_LENGTH 16
#define LOW_THRESHOLD 800
#define HIGH_THRESHOLD 1000
179 180
static void RunIntf( intf_thread_t *p_intf )
{
181 182 183
    int i_x, i_oldx = 0, i_sum = 0, i = 0;
    int p_oldx[FILTER_LENGTH];
    memset( p_oldx, 0, FILTER_LENGTH * sizeof( int ) );
184

185
    for( ;; )
186 187
    {
        vout_thread_t *p_vout;
Clément Stenac's avatar
Clément Stenac committed
188
        const char *psz_filter, *psz_type;
189
        bool b_change = false;
190 191 192 193

        /* Wait a bit, get orientation, change filter if necessary */
        msleep( INTF_IDLE_SLEEP );

194
        int canc = vlc_savecancel();
195
        i_x = GetOrientation( p_intf );
196 197 198 199
        i_sum += i_x - p_oldx[i];
        p_oldx[i++] = i_x;
        if( i == FILTER_LENGTH ) i = 0;
        i_x = i_sum / FILTER_LENGTH;
200

201 202 203 204
        if( p_intf->p_sys->b_use_rotate )
        {
            if( i_oldx != i_x )
            {
205 206 207 208 209
                /* TODO: cache object pointer */
                vlc_object_t *p_obj =
                vlc_object_find_name( p_intf->p_libvlc, "rotate", FIND_CHILD );
                if( p_obj )
                {
210 211
                    var_SetInteger( p_obj, "rotate-deciangle",
                            ((3600+i_x/2)%3600) );
212 213 214
                    i_oldx = i_x;
                    vlc_object_release( p_obj );
                }
215
            }
216
            goto loop;
217 218
        }

219 220
        if( i_x < -HIGH_THRESHOLD && i_oldx > -LOW_THRESHOLD )
        {
221
            b_change = true;
222 223 224 225 226 227
            psz_filter = "transform";
            psz_type = "270";
        }
        else if( ( i_x > -LOW_THRESHOLD && i_oldx < -HIGH_THRESHOLD )
                 || ( i_x < LOW_THRESHOLD && i_oldx > HIGH_THRESHOLD ) )
        {
228
            b_change = true;
229 230 231 232 233
            psz_filter = "";
            psz_type = "";
        }
        else if( i_x > HIGH_THRESHOLD && i_oldx < LOW_THRESHOLD )
        {
234
            b_change = true;
235 236 237 238
            psz_filter = "transform";
            psz_type = "90";
        }

239
        if( b_change )
240
        {
241 242 243 244 245 246 247
            p_vout = (vout_thread_t *)
                vlc_object_find( p_intf, VLC_OBJECT_VOUT, FIND_ANYWHERE );
            if( p_vout )
            {
                config_PutPsz( p_vout, "transform-type", psz_type );
                var_SetString( p_vout, "vout-filter", psz_filter );
                vlc_object_release( p_vout );
248

249 250
                i_oldx = i_x;
            }
251
        }
252 253
loop:
        vlc_restorecancel( canc );
254 255
    }
}
256 257 258
#undef FILTER_LENGTH
#undef LOW_THRESHOLD
#undef HIGH_THRESHOLD
259 260

/*****************************************************************************
261
 * GetOrientation: get laptop orientation, range -1800 / +1800
262 263 264 265
 *****************************************************************************/
static int GetOrientation( intf_thread_t *p_intf )
{
    FILE *f;
266 267
    int i_x, i_y, i_z = 0;

268 269 270 271 272 273 274 275 276 277 278 279 280
    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 );

281
        return ( i_x - p_intf->p_sys->i_calibrate ) * 10;
282 283 284 285 286 287 288 289 290 291 292

    case AMS_SENSOR:
        f = fopen( "/sys/devices/ams/x", "r" );
        if( !f )
        {
            return 0;
        }

        fscanf( f, "%d", &i_x);
        fclose( f );

293
        return - i_x * 30; /* FIXME: arbitrary */
294 295 296 297 298 299 300 301 302 303 304 305 306 307

    case APPLESMC_SENSOR:
        f = fopen( "/sys/devices/applesmc.768/position", "r" );
        if( !f )
        {
            return 0;
        }

        i_x = i_y = i_z = 0;
        fscanf( f, "(%d,%d,%d)", &i_x, &i_y, &i_z );
        fclose( f );

        return ( i_x - p_intf->p_sys->i_calibrate ) * 10;

308 309 310 311 312 313 314 315 316 317 318 319 320 321 322
#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;
Jérome Decoodt's avatar
Jérome Decoodt committed
323
#endif
324 325 326 327 328
    default:
        return 0;
    }
}