ams-pmu.c revision dcb69dd010c182507a8db8940618f6413f65e0af
1dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop/* 2dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop * Apple Motion Sensor driver (PMU variant) 3dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop * 4dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop * Copyright (C) 2006 Michael Hanselmann (linux-kernel@hansmi.ch) 5dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop * 6dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop * This program is free software; you can redistribute it and/or modify 7dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop * it under the terms of the GNU General Public License as published by 8dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop * the Free Software Foundation; either version 2 of the License, or 9dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop * (at your option) any later version. 10dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop */ 11dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 12dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#include <linux/module.h> 13dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#include <linux/types.h> 14dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#include <linux/errno.h> 15dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#include <linux/init.h> 16dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#include <linux/adb.h> 17dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#include <linux/pmu.h> 18dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 19dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#include "ams.h" 20dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 21dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop/* Attitude */ 22dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#define AMS_X 0x00 23dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#define AMS_Y 0x01 24dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#define AMS_Z 0x02 25dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 26dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop/* Not exactly known, maybe chip vendor */ 27dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#define AMS_VENDOR 0x03 28dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 29dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop/* Freefall registers */ 30dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#define AMS_FF_CLEAR 0x04 31dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#define AMS_FF_ENABLE 0x05 32dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#define AMS_FF_LOW_LIMIT 0x06 33dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#define AMS_FF_DEBOUNCE 0x07 34dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 35dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop/* Shock registers */ 36dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#define AMS_SHOCK_CLEAR 0x08 37dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#define AMS_SHOCK_ENABLE 0x09 38dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#define AMS_SHOCK_HIGH_LIMIT 0x0a 39dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#define AMS_SHOCK_DEBOUNCE 0x0b 40dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 41dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop/* Global interrupt and power control register */ 42dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop#define AMS_CONTROL 0x0c 43dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 44dcb69dd010c182507a8db8940618f6413f65e0afStelian Popstatic u8 ams_pmu_cmd; 45dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 46dcb69dd010c182507a8db8940618f6413f65e0afStelian Popstatic void ams_pmu_req_complete(struct adb_request *req) 47dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop{ 48dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop complete((struct completion *)req->arg); 49dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop} 50dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 51dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop/* Only call this function from task context */ 52dcb69dd010c182507a8db8940618f6413f65e0afStelian Popstatic void ams_pmu_set_register(u8 reg, u8 value) 53dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop{ 54dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop static struct adb_request req; 55dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop DECLARE_COMPLETION(req_complete); 56dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 57dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop req.arg = &req_complete; 58dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop if (pmu_request(&req, ams_pmu_req_complete, 4, ams_pmu_cmd, 0x00, reg, value)) 59dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop return; 60dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 61dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop wait_for_completion(&req_complete); 62dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop} 63dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 64dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop/* Only call this function from task context */ 65dcb69dd010c182507a8db8940618f6413f65e0afStelian Popstatic u8 ams_pmu_get_register(u8 reg) 66dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop{ 67dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop static struct adb_request req; 68dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop DECLARE_COMPLETION(req_complete); 69dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 70dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop req.arg = &req_complete; 71dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop if (pmu_request(&req, ams_pmu_req_complete, 3, ams_pmu_cmd, 0x01, reg)) 72dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop return 0; 73dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 74dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop wait_for_completion(&req_complete); 75dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 76dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop if (req.reply_len > 0) 77dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop return req.reply[0]; 78dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop else 79dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop return 0; 80dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop} 81dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 82dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop/* Enables or disables the specified interrupts */ 83dcb69dd010c182507a8db8940618f6413f65e0afStelian Popstatic void ams_pmu_set_irq(enum ams_irq reg, char enable) 84dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop{ 85dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop if (reg & AMS_IRQ_FREEFALL) { 86dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop u8 val = ams_pmu_get_register(AMS_FF_ENABLE); 87dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop if (enable) 88dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop val |= 0x80; 89dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop else 90dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop val &= ~0x80; 91dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_pmu_set_register(AMS_FF_ENABLE, val); 92dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop } 93dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 94dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop if (reg & AMS_IRQ_SHOCK) { 95dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop u8 val = ams_pmu_get_register(AMS_SHOCK_ENABLE); 96dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop if (enable) 97dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop val |= 0x80; 98dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop else 99dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop val &= ~0x80; 100dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_pmu_set_register(AMS_SHOCK_ENABLE, val); 101dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop } 102dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 103dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop if (reg & AMS_IRQ_GLOBAL) { 104dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop u8 val = ams_pmu_get_register(AMS_CONTROL); 105dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop if (enable) 106dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop val |= 0x80; 107dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop else 108dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop val &= ~0x80; 109dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_pmu_set_register(AMS_CONTROL, val); 110dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop } 111dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop} 112dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 113dcb69dd010c182507a8db8940618f6413f65e0afStelian Popstatic void ams_pmu_clear_irq(enum ams_irq reg) 114dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop{ 115dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop if (reg & AMS_IRQ_FREEFALL) 116dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_pmu_set_register(AMS_FF_CLEAR, 0x00); 117dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 118dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop if (reg & AMS_IRQ_SHOCK) 119dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_pmu_set_register(AMS_SHOCK_CLEAR, 0x00); 120dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop} 121dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 122dcb69dd010c182507a8db8940618f6413f65e0afStelian Popstatic u8 ams_pmu_get_vendor(void) 123dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop{ 124dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop return ams_pmu_get_register(AMS_VENDOR); 125dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop} 126dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 127dcb69dd010c182507a8db8940618f6413f65e0afStelian Popstatic void ams_pmu_get_xyz(s8 *x, s8 *y, s8 *z) 128dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop{ 129dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop *x = ams_pmu_get_register(AMS_X); 130dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop *y = ams_pmu_get_register(AMS_Y); 131dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop *z = ams_pmu_get_register(AMS_Z); 132dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop} 133dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 134dcb69dd010c182507a8db8940618f6413f65e0afStelian Popstatic void ams_pmu_exit(void) 135dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop{ 136dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop /* Disable interrupts */ 137dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_pmu_set_irq(AMS_IRQ_ALL, 0); 138dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 139dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop /* Clear interrupts */ 140dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_pmu_clear_irq(AMS_IRQ_ALL); 141dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 142dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_info.has_device = 0; 143dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 144dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop printk(KERN_INFO "ams: Unloading\n"); 145dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop} 146dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 147dcb69dd010c182507a8db8940618f6413f65e0afStelian Popint __init ams_pmu_init(struct device_node *np) 148dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop{ 149dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop u32 *prop; 150dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop int result; 151dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 152dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop mutex_lock(&ams_info.lock); 153dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 154dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop /* Set implementation stuff */ 155dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_info.of_node = np; 156dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_info.exit = ams_pmu_exit; 157dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_info.get_vendor = ams_pmu_get_vendor; 158dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_info.get_xyz = ams_pmu_get_xyz; 159dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_info.clear_irq = ams_pmu_clear_irq; 160dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_info.bustype = BUS_HOST; 161dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 162dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop /* Get PMU command, should be 0x4e, but we can never know */ 163dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop prop = (u32*)get_property(ams_info.of_node, "reg", NULL); 164dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop if (!prop) { 165dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop result = -ENODEV; 166dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop goto exit; 167dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop } 168dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_pmu_cmd = ((*prop) >> 8) & 0xff; 169dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 170dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop /* Disable interrupts */ 171dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_pmu_set_irq(AMS_IRQ_ALL, 0); 172dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 173dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop /* Clear interrupts */ 174dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_pmu_clear_irq(AMS_IRQ_ALL); 175dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 176dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop result = ams_sensor_attach(); 177dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop if (result < 0) 178dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop goto exit; 179dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 180dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop /* Set default values */ 181dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_pmu_set_register(AMS_FF_LOW_LIMIT, 0x15); 182dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_pmu_set_register(AMS_FF_ENABLE, 0x08); 183dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_pmu_set_register(AMS_FF_DEBOUNCE, 0x14); 184dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 185dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_pmu_set_register(AMS_SHOCK_HIGH_LIMIT, 0x60); 186dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_pmu_set_register(AMS_SHOCK_ENABLE, 0x0f); 187dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_pmu_set_register(AMS_SHOCK_DEBOUNCE, 0x14); 188dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 189dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_pmu_set_register(AMS_CONTROL, 0x4f); 190dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 191dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop /* Clear interrupts */ 192dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_pmu_clear_irq(AMS_IRQ_ALL); 193dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 194dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_info.has_device = 1; 195dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 196dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop /* Enable interrupts */ 197dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop ams_pmu_set_irq(AMS_IRQ_ALL, 1); 198dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 199dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop printk(KERN_INFO "ams: Found PMU based motion sensor\n"); 200dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 201dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop result = 0; 202dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 203dcb69dd010c182507a8db8940618f6413f65e0afStelian Popexit: 204dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop mutex_unlock(&ams_info.lock); 205dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop 206dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop return result; 207dcb69dd010c182507a8db8940618f6413f65e0afStelian Pop} 208