]>
git.proxmox.com Git - mirror_ubuntu-artful-kernel.git/blob - drivers/hwmon/ams/ams-pmu.c
2 * Apple Motion Sensor driver (PMU variant)
4 * Copyright (C) 2006 Michael Hanselmann (linux-kernel@hansmi.ch)
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
12 #include <linux/module.h>
13 #include <linux/types.h>
14 #include <linux/errno.h>
15 #include <linux/init.h>
16 #include <linux/adb.h>
17 #include <linux/pmu.h>
26 /* Not exactly known, maybe chip vendor */
27 #define AMS_VENDOR 0x03
29 /* Freefall registers */
30 #define AMS_FF_CLEAR 0x04
31 #define AMS_FF_ENABLE 0x05
32 #define AMS_FF_LOW_LIMIT 0x06
33 #define AMS_FF_DEBOUNCE 0x07
36 #define AMS_SHOCK_CLEAR 0x08
37 #define AMS_SHOCK_ENABLE 0x09
38 #define AMS_SHOCK_HIGH_LIMIT 0x0a
39 #define AMS_SHOCK_DEBOUNCE 0x0b
41 /* Global interrupt and power control register */
42 #define AMS_CONTROL 0x0c
44 static u8 ams_pmu_cmd
;
46 static void ams_pmu_req_complete(struct adb_request
*req
)
48 complete((struct completion
*)req
->arg
);
51 /* Only call this function from task context */
52 static void ams_pmu_set_register(u8 reg
, u8 value
)
54 static struct adb_request req
;
55 DECLARE_COMPLETION(req_complete
);
57 req
.arg
= &req_complete
;
58 if (pmu_request(&req
, ams_pmu_req_complete
, 4, ams_pmu_cmd
, 0x00, reg
, value
))
61 wait_for_completion(&req_complete
);
64 /* Only call this function from task context */
65 static u8
ams_pmu_get_register(u8 reg
)
67 static struct adb_request req
;
68 DECLARE_COMPLETION(req_complete
);
70 req
.arg
= &req_complete
;
71 if (pmu_request(&req
, ams_pmu_req_complete
, 3, ams_pmu_cmd
, 0x01, reg
))
74 wait_for_completion(&req_complete
);
76 if (req
.reply_len
> 0)
82 /* Enables or disables the specified interrupts */
83 static void ams_pmu_set_irq(enum ams_irq reg
, char enable
)
85 if (reg
& AMS_IRQ_FREEFALL
) {
86 u8 val
= ams_pmu_get_register(AMS_FF_ENABLE
);
91 ams_pmu_set_register(AMS_FF_ENABLE
, val
);
94 if (reg
& AMS_IRQ_SHOCK
) {
95 u8 val
= ams_pmu_get_register(AMS_SHOCK_ENABLE
);
100 ams_pmu_set_register(AMS_SHOCK_ENABLE
, val
);
103 if (reg
& AMS_IRQ_GLOBAL
) {
104 u8 val
= ams_pmu_get_register(AMS_CONTROL
);
109 ams_pmu_set_register(AMS_CONTROL
, val
);
113 static void ams_pmu_clear_irq(enum ams_irq reg
)
115 if (reg
& AMS_IRQ_FREEFALL
)
116 ams_pmu_set_register(AMS_FF_CLEAR
, 0x00);
118 if (reg
& AMS_IRQ_SHOCK
)
119 ams_pmu_set_register(AMS_SHOCK_CLEAR
, 0x00);
122 static u8
ams_pmu_get_vendor(void)
124 return ams_pmu_get_register(AMS_VENDOR
);
127 static void ams_pmu_get_xyz(s8
*x
, s8
*y
, s8
*z
)
129 *x
= ams_pmu_get_register(AMS_X
);
130 *y
= ams_pmu_get_register(AMS_Y
);
131 *z
= ams_pmu_get_register(AMS_Z
);
134 static void ams_pmu_exit(void)
136 /* Disable interrupts */
137 ams_pmu_set_irq(AMS_IRQ_ALL
, 0);
139 /* Clear interrupts */
140 ams_pmu_clear_irq(AMS_IRQ_ALL
);
142 ams_info
.has_device
= 0;
144 printk(KERN_INFO
"ams: Unloading\n");
147 int __init
ams_pmu_init(struct device_node
*np
)
152 /* Set implementation stuff */
153 ams_info
.of_node
= np
;
154 ams_info
.exit
= ams_pmu_exit
;
155 ams_info
.get_vendor
= ams_pmu_get_vendor
;
156 ams_info
.get_xyz
= ams_pmu_get_xyz
;
157 ams_info
.clear_irq
= ams_pmu_clear_irq
;
158 ams_info
.bustype
= BUS_HOST
;
160 /* Get PMU command, should be 0x4e, but we can never know */
161 prop
= of_get_property(ams_info
.of_node
, "reg", NULL
);
165 ams_pmu_cmd
= ((*prop
) >> 8) & 0xff;
167 /* Disable interrupts */
168 ams_pmu_set_irq(AMS_IRQ_ALL
, 0);
170 /* Clear interrupts */
171 ams_pmu_clear_irq(AMS_IRQ_ALL
);
173 result
= ams_sensor_attach();
177 /* Set default values */
178 ams_pmu_set_register(AMS_FF_LOW_LIMIT
, 0x15);
179 ams_pmu_set_register(AMS_FF_ENABLE
, 0x08);
180 ams_pmu_set_register(AMS_FF_DEBOUNCE
, 0x14);
182 ams_pmu_set_register(AMS_SHOCK_HIGH_LIMIT
, 0x60);
183 ams_pmu_set_register(AMS_SHOCK_ENABLE
, 0x0f);
184 ams_pmu_set_register(AMS_SHOCK_DEBOUNCE
, 0x14);
186 ams_pmu_set_register(AMS_CONTROL
, 0x4f);
188 /* Clear interrupts */
189 ams_pmu_clear_irq(AMS_IRQ_ALL
);
191 ams_info
.has_device
= 1;
193 /* Enable interrupts */
194 ams_pmu_set_irq(AMS_IRQ_ALL
, 1);
196 printk(KERN_INFO
"ams: Found PMU based motion sensor\n");