linux-imx

/*

 * Apple Motion Sensor driver

 *

 * Copyright (C) 2005 Stelian Pop (stelian@popies.net)

 * Copyright (C) 2006 Michael Hanselmann (linux-kernel@hansmi.ch)

 *

 * 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.

 */

​

#include <linux/module.h>

#include <linux/types.h>

#include <linux/errno.h>

#include <linux/init.h>

#include <linux/of_platform.h>

#include <asm/pmac_pfunc.h>

​

#include "ams.h"

​

/* There is only one motion sensor per machine */

struct ams ams_info;

​

static bool verbose;

module_param(verbose, bool, 0644);

MODULE_PARM_DESC(verbose, "Show free falls and shocks in kernel output");

​

/* Call with ams_info.lock held! */

void ams_sensors(s8 *x, s8 *y, s8 *z)

{

    u32 orient = ams_info.vflag? ams_info.orient1 : ams_info.orient2;

​

    if (orient & 0x80)

        /* X and Y swapped */

        ams_info.get_xyz(y, x, z);

    else

        ams_info.get_xyz(x, y, z);

​

    if (orient & 0x04)

        *z = ~(*z);

    if (orient & 0x02)

        *y = ~(*y);

    if (orient & 0x01)

        *x = ~(*x);

}

​

static ssize_t ams_show_current(struct device *dev,

    struct device_attribute *attr, char *buf)

{

    s8 x, y, z;

​

    mutex_lock(&ams_info.lock);

    ams_sensors(&x, &y, &z);