1dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop/* 2dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop * Apple Motion Sensor driver (I2C variant) 3dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop * 4dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop * Copyright (C) 2005 Stelian Pop (stelian@popies.net) 5dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop * Copyright (C) 2006 Michael Hanselmann (linux-kernel@hansmi.ch) 6dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop * 7dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop * Clean room implementation based on the reverse engineered Mac OS X driver by 8dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop * Johannes Berg <johannes@sipsolutions.net>, documentation available at 9dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop * http://johannes.sipsolutions.net/PowerBook/Apple_Motion_Sensor_Specification 10dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop * 11dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop * This program is free software; you can redistribute it and/or modify 12dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop * it under the terms of the GNU General Public License as published by 13dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop * the Free Software Foundation; either version 2 of the License, or 14dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop * (at your option) any later version. 15dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop */ 16dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 17dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#include <linux/module.h> 18dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#include <linux/types.h> 19dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#include <linux/errno.h> 20dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#include <linux/init.h> 21dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#include <linux/delay.h> 22dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 23dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#include "ams.h" 24dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 25dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop/* AMS registers */ 26dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#define AMS_COMMAND 0x00 /* command register */ 27dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#define AMS_STATUS 0x01 /* status register */ 28dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#define AMS_CTRL1 0x02 /* read control 1 (number of values) */ 29dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#define AMS_CTRL2 0x03 /* read control 2 (offset?) */ 30dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#define AMS_CTRL3 0x04 /* read control 3 (size of each value?) */ 31dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#define AMS_DATA1 0x05 /* read data 1 */ 32dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#define AMS_DATA2 0x06 /* read data 2 */ 33dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#define AMS_DATA3 0x07 /* read data 3 */ 34dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#define AMS_DATA4 0x08 /* read data 4 */ 35dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#define AMS_DATAX 0x20 /* data X */ 36dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#define AMS_DATAY 0x21 /* data Y */ 37dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#define AMS_DATAZ 0x22 /* data Z */ 38dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#define AMS_FREEFALL 0x24 /* freefall int control */ 39dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#define AMS_SHOCK 0x25 /* shock int control */ 40dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#define AMS_SENSLOW 0x26 /* sensitivity low limit */ 41dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#define AMS_SENSHIGH 0x27 /* sensitivity high limit */ 42dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#define AMS_CTRLX 0x28 /* control X */ 43dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#define AMS_CTRLY 0x29 /* control Y */ 44dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#define AMS_CTRLZ 0x2A /* control Z */ 45dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#define AMS_UNKNOWN1 0x2B /* unknown 1 */ 46dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#define AMS_UNKNOWN2 0x2C /* unknown 2 */ 47dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#define AMS_UNKNOWN3 0x2D /* unknown 3 */ 48dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#define AMS_VENDOR 0x2E /* vendor */ 49dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 50dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop/* AMS commands - use with the AMS_COMMAND register */ 51dcb69dd010c182507a8db8940618f6413f65e0afStelian Popenum ams_i2c_cmd { 52dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop AMS_CMD_NOOP = 0, 53dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop AMS_CMD_VERSION, 54dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop AMS_CMD_READMEM, 55dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop AMS_CMD_WRITEMEM, 56dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop AMS_CMD_ERASEMEM, 57dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop AMS_CMD_READEE, 58dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop AMS_CMD_WRITEEE, 59dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop AMS_CMD_RESET, 60dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop AMS_CMD_START, 61dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop}; 62dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 63810ad7b62c0f075dc44ecc781b24c7f6ba388da5Jean Delvarestatic int ams_i2c_probe(struct i2c_client *client, 64810ad7b62c0f075dc44ecc781b24c7f6ba388da5Jean Delvare const struct i2c_device_id *id); 65810ad7b62c0f075dc44ecc781b24c7f6ba388da5Jean Delvarestatic int ams_i2c_remove(struct i2c_client *client); 66810ad7b62c0f075dc44ecc781b24c7f6ba388da5Jean Delvare 67810ad7b62c0f075dc44ecc781b24c7f6ba388da5Jean Delvarestatic const struct i2c_device_id ams_id[] = { 6881e5d8646ff6bf323dddcf172aa3cef84468fa12Benjamin Herrenschmidt { "MAC,accelerometer_1", 0 }, 69810ad7b62c0f075dc44ecc781b24c7f6ba388da5Jean Delvare { } 70810ad7b62c0f075dc44ecc781b24c7f6ba388da5Jean Delvare}; 71810ad7b62c0f075dc44ecc781b24c7f6ba388da5Jean DelvareMODULE_DEVICE_TABLE(i2c, ams_id); 72dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 73dcb69dd010c182507a8db8940618f6413f65e0afStelian Popstatic struct i2c_driver ams_i2c_driver = { 74dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop .driver = { 75dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop .name = "ams", 76dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop .owner = THIS_MODULE, 77dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop }, 78810ad7b62c0f075dc44ecc781b24c7f6ba388da5Jean Delvare .probe = ams_i2c_probe, 79810ad7b62c0f075dc44ecc781b24c7f6ba388da5Jean Delvare .remove = ams_i2c_remove, 80810ad7b62c0f075dc44ecc781b24c7f6ba388da5Jean Delvare .id_table = ams_id, 81dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop}; 82dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 83dcb69dd010c182507a8db8940618f6413f65e0afStelian Popstatic s32 ams_i2c_read(u8 reg) 84dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop{ 85810ad7b62c0f075dc44ecc781b24c7f6ba388da5Jean Delvare return i2c_smbus_read_byte_data(ams_info.i2c_client, reg); 86dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop} 87dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 88dcb69dd010c182507a8db8940618f6413f65e0afStelian Popstatic int ams_i2c_write(u8 reg, u8 value) 89dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop{ 90810ad7b62c0f075dc44ecc781b24c7f6ba388da5Jean Delvare return i2c_smbus_write_byte_data(ams_info.i2c_client, reg, value); 91dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop} 92dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 93dcb69dd010c182507a8db8940618f6413f65e0afStelian Popstatic int ams_i2c_cmd(enum ams_i2c_cmd cmd) 94dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop{ 95dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop s32 result; 9663232dcd555d60d70ce8e09b53c8ef8e4a49a3f9Stelian Pop int count = 3; 97dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 98dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_i2c_write(AMS_COMMAND, cmd); 9963232dcd555d60d70ce8e09b53c8ef8e4a49a3f9Stelian Pop msleep(5); 100dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 10163232dcd555d60d70ce8e09b53c8ef8e4a49a3f9Stelian Pop while (count--) { 102dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop result = ams_i2c_read(AMS_COMMAND); 103dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop if (result == 0 || result & 0x80) 104dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop return 0; 105dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 10663232dcd555d60d70ce8e09b53c8ef8e4a49a3f9Stelian Pop schedule_timeout_uninterruptible(HZ / 20); 107dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop } 108dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 109dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop return -1; 110dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop} 111dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 112dcb69dd010c182507a8db8940618f6413f65e0afStelian Popstatic void ams_i2c_set_irq(enum ams_irq reg, char enable) 113dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop{ 114dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop if (reg & AMS_IRQ_FREEFALL) { 115dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop u8 val = ams_i2c_read(AMS_CTRLX); 116dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop if (enable) 117dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop val |= 0x80; 118dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop else 119dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop val &= ~0x80; 120dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_i2c_write(AMS_CTRLX, val); 121dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop } 122dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 123dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop if (reg & AMS_IRQ_SHOCK) { 124dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop u8 val = ams_i2c_read(AMS_CTRLY); 125dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop if (enable) 126dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop val |= 0x80; 127dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop else 128dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop val &= ~0x80; 129dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_i2c_write(AMS_CTRLY, val); 130dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop } 131dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 132dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop if (reg & AMS_IRQ_GLOBAL) { 133dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop u8 val = ams_i2c_read(AMS_CTRLZ); 134dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop if (enable) 135dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop val |= 0x80; 136dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop else 137dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop val &= ~0x80; 138dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_i2c_write(AMS_CTRLZ, val); 139dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop } 140dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop} 141dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 142dcb69dd010c182507a8db8940618f6413f65e0afStelian Popstatic void ams_i2c_clear_irq(enum ams_irq reg) 143dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop{ 144dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop if (reg & AMS_IRQ_FREEFALL) 145dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_i2c_write(AMS_FREEFALL, 0); 146dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 147dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop if (reg & AMS_IRQ_SHOCK) 148dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_i2c_write(AMS_SHOCK, 0); 149dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop} 150dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 151dcb69dd010c182507a8db8940618f6413f65e0afStelian Popstatic u8 ams_i2c_get_vendor(void) 152dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop{ 153dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop return ams_i2c_read(AMS_VENDOR); 154dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop} 155dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 156dcb69dd010c182507a8db8940618f6413f65e0afStelian Popstatic void ams_i2c_get_xyz(s8 *x, s8 *y, s8 *z) 157dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop{ 158dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop *x = ams_i2c_read(AMS_DATAX); 159dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop *y = ams_i2c_read(AMS_DATAY); 160dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop *z = ams_i2c_read(AMS_DATAZ); 161dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop} 162dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 163810ad7b62c0f075dc44ecc781b24c7f6ba388da5Jean Delvarestatic int ams_i2c_probe(struct i2c_client *client, 164810ad7b62c0f075dc44ecc781b24c7f6ba388da5Jean Delvare const struct i2c_device_id *id) 165dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop{ 166dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop int vmaj, vmin; 167dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop int result; 168dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 169dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop /* There can be only one */ 170dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop if (unlikely(ams_info.has_device)) 171dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop return -ENODEV; 172dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 173810ad7b62c0f075dc44ecc781b24c7f6ba388da5Jean Delvare ams_info.i2c_client = client; 174dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 175dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop if (ams_i2c_cmd(AMS_CMD_RESET)) { 176dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop printk(KERN_INFO "ams: Failed to reset the device\n"); 177dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop return -ENODEV; 178dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop } 179dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 180dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop if (ams_i2c_cmd(AMS_CMD_START)) { 181dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop printk(KERN_INFO "ams: Failed to start the device\n"); 182dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop return -ENODEV; 183dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop } 184dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 185dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop /* get version/vendor information */ 186dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_i2c_write(AMS_CTRL1, 0x02); 187dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_i2c_write(AMS_CTRL2, 0x85); 188dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_i2c_write(AMS_CTRL3, 0x01); 189dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 190dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_i2c_cmd(AMS_CMD_READMEM); 191dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 192dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop vmaj = ams_i2c_read(AMS_DATA1); 193dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop vmin = ams_i2c_read(AMS_DATA2); 194dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop if (vmaj != 1 || vmin != 52) { 195dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop printk(KERN_INFO "ams: Incorrect device version (%d.%d)\n", 196dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop vmaj, vmin); 197dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop return -ENODEV; 198dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop } 199dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 200dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_i2c_cmd(AMS_CMD_VERSION); 201dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 202dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop vmaj = ams_i2c_read(AMS_DATA1); 203dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop vmin = ams_i2c_read(AMS_DATA2); 204dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop if (vmaj != 0 || vmin != 1) { 205dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop printk(KERN_INFO "ams: Incorrect firmware version (%d.%d)\n", 206dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop vmaj, vmin); 207dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop return -ENODEV; 208dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop } 209dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 210dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop /* Disable interrupts */ 211dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_i2c_set_irq(AMS_IRQ_ALL, 0); 212dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 213dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop result = ams_sensor_attach(); 214dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop if (result < 0) 215dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop return result; 216dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 217dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop /* Set default values */ 218dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_i2c_write(AMS_SENSLOW, 0x15); 219dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_i2c_write(AMS_SENSHIGH, 0x60); 220dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_i2c_write(AMS_CTRLX, 0x08); 221dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_i2c_write(AMS_CTRLY, 0x0F); 222dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_i2c_write(AMS_CTRLZ, 0x4F); 223dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_i2c_write(AMS_UNKNOWN1, 0x14); 224dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 225dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop /* Clear interrupts */ 226dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_i2c_clear_irq(AMS_IRQ_ALL); 227dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 228dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_info.has_device = 1; 229dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 230dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop /* Enable interrupts */ 231dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_i2c_set_irq(AMS_IRQ_ALL, 1); 232dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 233dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop printk(KERN_INFO "ams: Found I2C based motion sensor\n"); 234dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 235dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop return 0; 236dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop} 237dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 238810ad7b62c0f075dc44ecc781b24c7f6ba388da5Jean Delvarestatic int ams_i2c_remove(struct i2c_client *client) 239dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop{ 240dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop if (ams_info.has_device) { 24198ceb75c7c14eada76b0aa9f03a635a735cee3cbJean Delvare ams_sensor_detach(); 24298ceb75c7c14eada76b0aa9f03a635a735cee3cbJean Delvare 243dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop /* Disable interrupts */ 244dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_i2c_set_irq(AMS_IRQ_ALL, 0); 245dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 246dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop /* Clear interrupts */ 247dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_i2c_clear_irq(AMS_IRQ_ALL); 248dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 249dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop printk(KERN_INFO "ams: Unloading\n"); 250dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 251dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_info.has_device = 0; 252dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop } 253dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 254dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop return 0; 255dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop} 256dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 257dcb69dd010c182507a8db8940618f6413f65e0afStelian Popstatic void ams_i2c_exit(void) 258dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop{ 259dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop i2c_del_driver(&ams_i2c_driver); 260dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop} 261dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 262dcb69dd010c182507a8db8940618f6413f65e0afStelian Popint __init ams_i2c_init(struct device_node *np) 263dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop{ 264dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop int result; 265dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 266dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop /* Set implementation stuff */ 267dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_info.of_node = np; 268dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_info.exit = ams_i2c_exit; 269dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_info.get_vendor = ams_i2c_get_vendor; 270dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_info.get_xyz = ams_i2c_get_xyz; 271dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_info.clear_irq = ams_i2c_clear_irq; 272dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_info.bustype = BUS_I2C; 273dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 274dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop result = i2c_add_driver(&ams_i2c_driver); 275dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 276dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop return result; 277dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop} 278