Loading...
1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 * Synaptics NavPoint (PXA27x SSP/SPI) driver.
4 *
5 * Copyright (C) 2012 Paul Parsons <lost.distance@yahoo.com>
6 */
7
8#include <linux/kernel.h>
9#include <linux/module.h>
10#include <linux/platform_device.h>
11#include <linux/clk.h>
12#include <linux/delay.h>
13#include <linux/gpio/consumer.h>
14#include <linux/input.h>
15#include <linux/input/navpoint.h>
16#include <linux/interrupt.h>
17#include <linux/mutex.h>
18#include <linux/pxa2xx_ssp.h>
19#include <linux/slab.h>
20
21/*
22 * Synaptics Modular Embedded Protocol: Module Packet Format.
23 * Module header byte 2:0 = Length (# bytes that follow)
24 * Module header byte 4:3 = Control
25 * Module header byte 7:5 = Module Address
26 */
27#define HEADER_LENGTH(byte) ((byte) & 0x07)
28#define HEADER_CONTROL(byte) (((byte) >> 3) & 0x03)
29#define HEADER_ADDRESS(byte) ((byte) >> 5)
30
31struct navpoint {
32 struct ssp_device *ssp;
33 struct input_dev *input;
34 struct device *dev;
35 struct gpio_desc *gpiod;
36 int index;
37 u8 data[1 + HEADER_LENGTH(0xff)];
38};
39
40/*
41 * Initialization values for SSCR0_x, SSCR1_x, SSSR_x.
42 */
43static const u32 sscr0 = 0
44 | SSCR0_TUM /* TIM = 1; No TUR interrupts */
45 | SSCR0_RIM /* RIM = 1; No ROR interrupts */
46 | SSCR0_SSE /* SSE = 1; SSP enabled */
47 | SSCR0_Motorola /* FRF = 0; Motorola SPI */
48 | SSCR0_DataSize(16) /* DSS = 15; Data size = 16-bit */
49 ;
50static const u32 sscr1 = 0
51 | SSCR1_SCFR /* SCFR = 1; SSPSCLK only during transfers */
52 | SSCR1_SCLKDIR /* SCLKDIR = 1; Slave mode */
53 | SSCR1_SFRMDIR /* SFRMDIR = 1; Slave mode */
54 | SSCR1_RWOT /* RWOT = 1; Receive without transmit mode */
55 | SSCR1_RxTresh(1) /* RFT = 0; Receive FIFO threshold = 1 */
56 | SSCR1_SPH /* SPH = 1; SSPSCLK inactive 0.5 + 1 cycles */
57 | SSCR1_RIE /* RIE = 1; Receive FIFO interrupt enabled */
58 ;
59static const u32 sssr = 0
60 | SSSR_BCE /* BCE = 1; Clear BCE */
61 | SSSR_TUR /* TUR = 1; Clear TUR */
62 | SSSR_EOC /* EOC = 1; Clear EOC */
63 | SSSR_TINT /* TINT = 1; Clear TINT */
64 | SSSR_PINT /* PINT = 1; Clear PINT */
65 | SSSR_ROR /* ROR = 1; Clear ROR */
66 ;
67
68/*
69 * MEP Query $22: Touchpad Coordinate Range Query is not supported by
70 * the NavPoint module, so sampled values provide the default limits.
71 */
72#define NAVPOINT_X_MIN 1278
73#define NAVPOINT_X_MAX 5340
74#define NAVPOINT_Y_MIN 1572
75#define NAVPOINT_Y_MAX 4396
76#define NAVPOINT_PRESSURE_MIN 0
77#define NAVPOINT_PRESSURE_MAX 255
78
79static void navpoint_packet(struct navpoint *navpoint)
80{
81 int finger;
82 int gesture;
83 int x, y, z;
84
85 switch (navpoint->data[0]) {
86 case 0xff: /* Garbage (packet?) between reset and Hello packet */
87 case 0x00: /* Module 0, NULL packet */
88 break;
89
90 case 0x0e: /* Module 0, Absolute packet */
91 finger = (navpoint->data[1] & 0x01);
92 gesture = (navpoint->data[1] & 0x02);
93 x = ((navpoint->data[2] & 0x1f) << 8) | navpoint->data[3];
94 y = ((navpoint->data[4] & 0x1f) << 8) | navpoint->data[5];
95 z = navpoint->data[6];
96 input_report_key(navpoint->input, BTN_TOUCH, finger);
97 input_report_abs(navpoint->input, ABS_X, x);
98 input_report_abs(navpoint->input, ABS_Y, y);
99 input_report_abs(navpoint->input, ABS_PRESSURE, z);
100 input_report_key(navpoint->input, BTN_TOOL_FINGER, finger);
101 input_report_key(navpoint->input, BTN_LEFT, gesture);
102 input_sync(navpoint->input);
103 break;
104
105 case 0x19: /* Module 0, Hello packet */
106 if ((navpoint->data[1] & 0xf0) == 0x10)
107 break;
108 fallthrough;
109 default:
110 dev_warn(navpoint->dev,
111 "spurious packet: data=0x%02x,0x%02x,...\n",
112 navpoint->data[0], navpoint->data[1]);
113 break;
114 }
115}
116
117static irqreturn_t navpoint_irq(int irq, void *dev_id)
118{
119 struct navpoint *navpoint = dev_id;
120 struct ssp_device *ssp = navpoint->ssp;
121 irqreturn_t ret = IRQ_NONE;
122 u32 status;
123
124 status = pxa_ssp_read_reg(ssp, SSSR);
125 if (status & sssr) {
126 dev_warn(navpoint->dev,
127 "unexpected interrupt: status=0x%08x\n", status);
128 pxa_ssp_write_reg(ssp, SSSR, (status & sssr));
129 ret = IRQ_HANDLED;
130 }
131
132 while (status & SSSR_RNE) {
133 u32 data;
134
135 data = pxa_ssp_read_reg(ssp, SSDR);
136 navpoint->data[navpoint->index + 0] = (data >> 8);
137 navpoint->data[navpoint->index + 1] = data;
138 navpoint->index += 2;
139 if (HEADER_LENGTH(navpoint->data[0]) < navpoint->index) {
140 navpoint_packet(navpoint);
141 navpoint->index = 0;
142 }
143 status = pxa_ssp_read_reg(ssp, SSSR);
144 ret = IRQ_HANDLED;
145 }
146
147 return ret;
148}
149
150static void navpoint_up(struct navpoint *navpoint)
151{
152 struct ssp_device *ssp = navpoint->ssp;
153 int timeout;
154
155 clk_prepare_enable(ssp->clk);
156
157 pxa_ssp_write_reg(ssp, SSCR1, sscr1);
158 pxa_ssp_write_reg(ssp, SSSR, sssr);
159 pxa_ssp_write_reg(ssp, SSTO, 0);
160 pxa_ssp_write_reg(ssp, SSCR0, sscr0); /* SSCR0_SSE written last */
161
162 /* Wait until SSP port is ready for slave clock operations */
163 for (timeout = 100; timeout != 0; --timeout) {
164 if (!(pxa_ssp_read_reg(ssp, SSSR) & SSSR_CSS))
165 break;
166 msleep(1);
167 }
168
169 if (timeout == 0)
170 dev_err(navpoint->dev,
171 "timeout waiting for SSSR[CSS] to clear\n");
172
173 gpiod_set_value(navpoint->gpiod, 1);
174}
175
176static void navpoint_down(struct navpoint *navpoint)
177{
178 struct ssp_device *ssp = navpoint->ssp;
179
180 gpiod_set_value(navpoint->gpiod, 0);
181
182 pxa_ssp_write_reg(ssp, SSCR0, 0);
183
184 clk_disable_unprepare(ssp->clk);
185}
186
187static int navpoint_open(struct input_dev *input)
188{
189 struct navpoint *navpoint = input_get_drvdata(input);
190
191 navpoint_up(navpoint);
192
193 return 0;
194}
195
196static void navpoint_close(struct input_dev *input)
197{
198 struct navpoint *navpoint = input_get_drvdata(input);
199
200 navpoint_down(navpoint);
201}
202
203static int navpoint_probe(struct platform_device *pdev)
204{
205 const struct navpoint_platform_data *pdata =
206 dev_get_platdata(&pdev->dev);
207 struct ssp_device *ssp;
208 struct input_dev *input;
209 struct navpoint *navpoint;
210 int error;
211
212 if (!pdata) {
213 dev_err(&pdev->dev, "no platform data\n");
214 return -EINVAL;
215 }
216
217 ssp = pxa_ssp_request(pdata->port, pdev->name);
218 if (!ssp)
219 return -ENODEV;
220
221 /* HaRET does not disable devices before jumping into Linux */
222 if (pxa_ssp_read_reg(ssp, SSCR0) & SSCR0_SSE) {
223 pxa_ssp_write_reg(ssp, SSCR0, 0);
224 dev_warn(&pdev->dev, "ssp%d already enabled\n", pdata->port);
225 }
226
227 navpoint = kzalloc(sizeof(*navpoint), GFP_KERNEL);
228 input = input_allocate_device();
229 if (!navpoint || !input) {
230 error = -ENOMEM;
231 goto err_free_mem;
232 }
233
234 navpoint->gpiod = gpiod_get_optional(&pdev->dev,
235 NULL, GPIOD_OUT_LOW);
236 if (IS_ERR(navpoint->gpiod)) {
237 error = PTR_ERR(navpoint->gpiod);
238 dev_err(&pdev->dev, "error getting GPIO\n");
239 goto err_free_mem;
240 }
241 gpiod_set_consumer_name(navpoint->gpiod, "SYNAPTICS_ON");
242
243 navpoint->ssp = ssp;
244 navpoint->input = input;
245 navpoint->dev = &pdev->dev;
246
247 input->name = pdev->name;
248 input->dev.parent = &pdev->dev;
249
250 __set_bit(EV_KEY, input->evbit);
251 __set_bit(EV_ABS, input->evbit);
252 __set_bit(BTN_LEFT, input->keybit);
253 __set_bit(BTN_TOUCH, input->keybit);
254 __set_bit(BTN_TOOL_FINGER, input->keybit);
255
256 input_set_abs_params(input, ABS_X,
257 NAVPOINT_X_MIN, NAVPOINT_X_MAX, 0, 0);
258 input_set_abs_params(input, ABS_Y,
259 NAVPOINT_Y_MIN, NAVPOINT_Y_MAX, 0, 0);
260 input_set_abs_params(input, ABS_PRESSURE,
261 NAVPOINT_PRESSURE_MIN, NAVPOINT_PRESSURE_MAX,
262 0, 0);
263
264 input->open = navpoint_open;
265 input->close = navpoint_close;
266
267 input_set_drvdata(input, navpoint);
268
269 error = request_irq(ssp->irq, navpoint_irq, 0, pdev->name, navpoint);
270 if (error)
271 goto err_free_mem;
272
273 error = input_register_device(input);
274 if (error)
275 goto err_free_irq;
276
277 platform_set_drvdata(pdev, navpoint);
278 dev_dbg(&pdev->dev, "ssp%d, irq %d\n", pdata->port, ssp->irq);
279
280 return 0;
281
282err_free_irq:
283 free_irq(ssp->irq, navpoint);
284err_free_mem:
285 input_free_device(input);
286 kfree(navpoint);
287 pxa_ssp_free(ssp);
288
289 return error;
290}
291
292static void navpoint_remove(struct platform_device *pdev)
293{
294 struct navpoint *navpoint = platform_get_drvdata(pdev);
295 struct ssp_device *ssp = navpoint->ssp;
296
297 free_irq(ssp->irq, navpoint);
298
299 input_unregister_device(navpoint->input);
300 kfree(navpoint);
301
302 pxa_ssp_free(ssp);
303}
304
305static int navpoint_suspend(struct device *dev)
306{
307 struct platform_device *pdev = to_platform_device(dev);
308 struct navpoint *navpoint = platform_get_drvdata(pdev);
309 struct input_dev *input = navpoint->input;
310
311 mutex_lock(&input->mutex);
312 if (input_device_enabled(input))
313 navpoint_down(navpoint);
314 mutex_unlock(&input->mutex);
315
316 return 0;
317}
318
319static int navpoint_resume(struct device *dev)
320{
321 struct platform_device *pdev = to_platform_device(dev);
322 struct navpoint *navpoint = platform_get_drvdata(pdev);
323 struct input_dev *input = navpoint->input;
324
325 mutex_lock(&input->mutex);
326 if (input_device_enabled(input))
327 navpoint_up(navpoint);
328 mutex_unlock(&input->mutex);
329
330 return 0;
331}
332
333static DEFINE_SIMPLE_DEV_PM_OPS(navpoint_pm_ops,
334 navpoint_suspend, navpoint_resume);
335
336static struct platform_driver navpoint_driver = {
337 .probe = navpoint_probe,
338 .remove_new = navpoint_remove,
339 .driver = {
340 .name = "navpoint",
341 .pm = pm_sleep_ptr(&navpoint_pm_ops),
342 },
343};
344
345module_platform_driver(navpoint_driver);
346
347MODULE_AUTHOR("Paul Parsons <lost.distance@yahoo.com>");
348MODULE_DESCRIPTION("Synaptics NavPoint (PXA27x SSP/SPI) driver");
349MODULE_LICENSE("GPL");
350MODULE_ALIAS("platform:navpoint");
1/*
2 * Synaptics NavPoint (PXA27x SSP/SPI) driver.
3 *
4 * Copyright (C) 2012 Paul Parsons <lost.distance@yahoo.com>
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License version 2 as
8 * published by the Free Software Foundation.
9 */
10
11#include <linux/kernel.h>
12#include <linux/init.h>
13#include <linux/module.h>
14#include <linux/platform_device.h>
15#include <linux/clk.h>
16#include <linux/delay.h>
17#include <linux/gpio.h>
18#include <linux/input.h>
19#include <linux/input/navpoint.h>
20#include <linux/interrupt.h>
21#include <linux/mutex.h>
22#include <linux/pxa2xx_ssp.h>
23#include <linux/slab.h>
24
25/*
26 * Synaptics Modular Embedded Protocol: Module Packet Format.
27 * Module header byte 2:0 = Length (# bytes that follow)
28 * Module header byte 4:3 = Control
29 * Module header byte 7:5 = Module Address
30 */
31#define HEADER_LENGTH(byte) ((byte) & 0x07)
32#define HEADER_CONTROL(byte) (((byte) >> 3) & 0x03)
33#define HEADER_ADDRESS(byte) ((byte) >> 5)
34
35struct navpoint {
36 struct ssp_device *ssp;
37 struct input_dev *input;
38 struct device *dev;
39 int gpio;
40 int index;
41 u8 data[1 + HEADER_LENGTH(0xff)];
42};
43
44/*
45 * Initialization values for SSCR0_x, SSCR1_x, SSSR_x.
46 */
47static const u32 sscr0 = 0
48 | SSCR0_TUM /* TIM = 1; No TUR interrupts */
49 | SSCR0_RIM /* RIM = 1; No ROR interrupts */
50 | SSCR0_SSE /* SSE = 1; SSP enabled */
51 | SSCR0_Motorola /* FRF = 0; Motorola SPI */
52 | SSCR0_DataSize(16) /* DSS = 15; Data size = 16-bit */
53 ;
54static const u32 sscr1 = 0
55 | SSCR1_SCFR /* SCFR = 1; SSPSCLK only during transfers */
56 | SSCR1_SCLKDIR /* SCLKDIR = 1; Slave mode */
57 | SSCR1_SFRMDIR /* SFRMDIR = 1; Slave mode */
58 | SSCR1_RWOT /* RWOT = 1; Receive without transmit mode */
59 | SSCR1_RxTresh(1) /* RFT = 0; Receive FIFO threshold = 1 */
60 | SSCR1_SPH /* SPH = 1; SSPSCLK inactive 0.5 + 1 cycles */
61 | SSCR1_RIE /* RIE = 1; Receive FIFO interrupt enabled */
62 ;
63static const u32 sssr = 0
64 | SSSR_BCE /* BCE = 1; Clear BCE */
65 | SSSR_TUR /* TUR = 1; Clear TUR */
66 | SSSR_EOC /* EOC = 1; Clear EOC */
67 | SSSR_TINT /* TINT = 1; Clear TINT */
68 | SSSR_PINT /* PINT = 1; Clear PINT */
69 | SSSR_ROR /* ROR = 1; Clear ROR */
70 ;
71
72/*
73 * MEP Query $22: Touchpad Coordinate Range Query is not supported by
74 * the NavPoint module, so sampled values provide the default limits.
75 */
76#define NAVPOINT_X_MIN 1278
77#define NAVPOINT_X_MAX 5340
78#define NAVPOINT_Y_MIN 1572
79#define NAVPOINT_Y_MAX 4396
80#define NAVPOINT_PRESSURE_MIN 0
81#define NAVPOINT_PRESSURE_MAX 255
82
83static void navpoint_packet(struct navpoint *navpoint)
84{
85 int finger;
86 int gesture;
87 int x, y, z;
88
89 switch (navpoint->data[0]) {
90 case 0xff: /* Garbage (packet?) between reset and Hello packet */
91 case 0x00: /* Module 0, NULL packet */
92 break;
93
94 case 0x0e: /* Module 0, Absolute packet */
95 finger = (navpoint->data[1] & 0x01);
96 gesture = (navpoint->data[1] & 0x02);
97 x = ((navpoint->data[2] & 0x1f) << 8) | navpoint->data[3];
98 y = ((navpoint->data[4] & 0x1f) << 8) | navpoint->data[5];
99 z = navpoint->data[6];
100 input_report_key(navpoint->input, BTN_TOUCH, finger);
101 input_report_abs(navpoint->input, ABS_X, x);
102 input_report_abs(navpoint->input, ABS_Y, y);
103 input_report_abs(navpoint->input, ABS_PRESSURE, z);
104 input_report_key(navpoint->input, BTN_TOOL_FINGER, finger);
105 input_report_key(navpoint->input, BTN_LEFT, gesture);
106 input_sync(navpoint->input);
107 break;
108
109 case 0x19: /* Module 0, Hello packet */
110 if ((navpoint->data[1] & 0xf0) == 0x10)
111 break;
112 /* FALLTHROUGH */
113 default:
114 dev_warn(navpoint->dev,
115 "spurious packet: data=0x%02x,0x%02x,...\n",
116 navpoint->data[0], navpoint->data[1]);
117 break;
118 }
119}
120
121static irqreturn_t navpoint_irq(int irq, void *dev_id)
122{
123 struct navpoint *navpoint = dev_id;
124 struct ssp_device *ssp = navpoint->ssp;
125 irqreturn_t ret = IRQ_NONE;
126 u32 status;
127
128 status = pxa_ssp_read_reg(ssp, SSSR);
129 if (status & sssr) {
130 dev_warn(navpoint->dev,
131 "unexpected interrupt: status=0x%08x\n", status);
132 pxa_ssp_write_reg(ssp, SSSR, (status & sssr));
133 ret = IRQ_HANDLED;
134 }
135
136 while (status & SSSR_RNE) {
137 u32 data;
138
139 data = pxa_ssp_read_reg(ssp, SSDR);
140 navpoint->data[navpoint->index + 0] = (data >> 8);
141 navpoint->data[navpoint->index + 1] = data;
142 navpoint->index += 2;
143 if (HEADER_LENGTH(navpoint->data[0]) < navpoint->index) {
144 navpoint_packet(navpoint);
145 navpoint->index = 0;
146 }
147 status = pxa_ssp_read_reg(ssp, SSSR);
148 ret = IRQ_HANDLED;
149 }
150
151 return ret;
152}
153
154static void navpoint_up(struct navpoint *navpoint)
155{
156 struct ssp_device *ssp = navpoint->ssp;
157 int timeout;
158
159 clk_prepare_enable(ssp->clk);
160
161 pxa_ssp_write_reg(ssp, SSCR1, sscr1);
162 pxa_ssp_write_reg(ssp, SSSR, sssr);
163 pxa_ssp_write_reg(ssp, SSTO, 0);
164 pxa_ssp_write_reg(ssp, SSCR0, sscr0); /* SSCR0_SSE written last */
165
166 /* Wait until SSP port is ready for slave clock operations */
167 for (timeout = 100; timeout != 0; --timeout) {
168 if (!(pxa_ssp_read_reg(ssp, SSSR) & SSSR_CSS))
169 break;
170 msleep(1);
171 }
172
173 if (timeout == 0)
174 dev_err(navpoint->dev,
175 "timeout waiting for SSSR[CSS] to clear\n");
176
177 if (gpio_is_valid(navpoint->gpio))
178 gpio_set_value(navpoint->gpio, 1);
179}
180
181static void navpoint_down(struct navpoint *navpoint)
182{
183 struct ssp_device *ssp = navpoint->ssp;
184
185 if (gpio_is_valid(navpoint->gpio))
186 gpio_set_value(navpoint->gpio, 0);
187
188 pxa_ssp_write_reg(ssp, SSCR0, 0);
189
190 clk_disable_unprepare(ssp->clk);
191}
192
193static int navpoint_open(struct input_dev *input)
194{
195 struct navpoint *navpoint = input_get_drvdata(input);
196
197 navpoint_up(navpoint);
198
199 return 0;
200}
201
202static void navpoint_close(struct input_dev *input)
203{
204 struct navpoint *navpoint = input_get_drvdata(input);
205
206 navpoint_down(navpoint);
207}
208
209static int __devinit navpoint_probe(struct platform_device *pdev)
210{
211 const struct navpoint_platform_data *pdata =
212 dev_get_platdata(&pdev->dev);
213 struct ssp_device *ssp;
214 struct input_dev *input;
215 struct navpoint *navpoint;
216 int error;
217
218 if (!pdata) {
219 dev_err(&pdev->dev, "no platform data\n");
220 return -EINVAL;
221 }
222
223 if (gpio_is_valid(pdata->gpio)) {
224 error = gpio_request_one(pdata->gpio, GPIOF_OUT_INIT_LOW,
225 "SYNAPTICS_ON");
226 if (error)
227 return error;
228 }
229
230 ssp = pxa_ssp_request(pdata->port, pdev->name);
231 if (!ssp) {
232 error = -ENODEV;
233 goto err_free_gpio;
234 }
235
236 /* HaRET does not disable devices before jumping into Linux */
237 if (pxa_ssp_read_reg(ssp, SSCR0) & SSCR0_SSE) {
238 pxa_ssp_write_reg(ssp, SSCR0, 0);
239 dev_warn(&pdev->dev, "ssp%d already enabled\n", pdata->port);
240 }
241
242 navpoint = kzalloc(sizeof(*navpoint), GFP_KERNEL);
243 input = input_allocate_device();
244 if (!navpoint || !input) {
245 error = -ENOMEM;
246 goto err_free_mem;
247 }
248
249 navpoint->ssp = ssp;
250 navpoint->input = input;
251 navpoint->dev = &pdev->dev;
252 navpoint->gpio = pdata->gpio;
253
254 input->name = pdev->name;
255 input->dev.parent = &pdev->dev;
256
257 __set_bit(EV_KEY, input->evbit);
258 __set_bit(EV_ABS, input->evbit);
259 __set_bit(BTN_LEFT, input->keybit);
260 __set_bit(BTN_TOUCH, input->keybit);
261 __set_bit(BTN_TOOL_FINGER, input->keybit);
262
263 input_set_abs_params(input, ABS_X,
264 NAVPOINT_X_MIN, NAVPOINT_X_MAX, 0, 0);
265 input_set_abs_params(input, ABS_Y,
266 NAVPOINT_Y_MIN, NAVPOINT_Y_MAX, 0, 0);
267 input_set_abs_params(input, ABS_PRESSURE,
268 NAVPOINT_PRESSURE_MIN, NAVPOINT_PRESSURE_MAX,
269 0, 0);
270
271 input->open = navpoint_open;
272 input->close = navpoint_close;
273
274 input_set_drvdata(input, navpoint);
275
276 error = request_irq(ssp->irq, navpoint_irq, 0, pdev->name, navpoint);
277 if (error)
278 goto err_free_mem;
279
280 error = input_register_device(input);
281 if (error)
282 goto err_free_irq;
283
284 platform_set_drvdata(pdev, navpoint);
285 dev_dbg(&pdev->dev, "ssp%d, irq %d\n", pdata->port, ssp->irq);
286
287 return 0;
288
289err_free_irq:
290 free_irq(ssp->irq, &pdev->dev);
291err_free_mem:
292 input_free_device(input);
293 kfree(navpoint);
294 pxa_ssp_free(ssp);
295err_free_gpio:
296 if (gpio_is_valid(pdata->gpio))
297 gpio_free(pdata->gpio);
298
299 return error;
300}
301
302static int __devexit navpoint_remove(struct platform_device *pdev)
303{
304 const struct navpoint_platform_data *pdata =
305 dev_get_platdata(&pdev->dev);
306 struct navpoint *navpoint = platform_get_drvdata(pdev);
307 struct ssp_device *ssp = navpoint->ssp;
308
309 free_irq(ssp->irq, navpoint);
310
311 input_unregister_device(navpoint->input);
312 kfree(navpoint);
313
314 pxa_ssp_free(ssp);
315
316 if (gpio_is_valid(pdata->gpio))
317 gpio_free(pdata->gpio);
318
319 return 0;
320}
321
322#ifdef CONFIG_PM_SLEEP
323static int navpoint_suspend(struct device *dev)
324{
325 struct platform_device *pdev = to_platform_device(dev);
326 struct navpoint *navpoint = platform_get_drvdata(pdev);
327 struct input_dev *input = navpoint->input;
328
329 mutex_lock(&input->mutex);
330 if (input->users)
331 navpoint_down(navpoint);
332 mutex_unlock(&input->mutex);
333
334 return 0;
335}
336
337static int navpoint_resume(struct device *dev)
338{
339 struct platform_device *pdev = to_platform_device(dev);
340 struct navpoint *navpoint = platform_get_drvdata(pdev);
341 struct input_dev *input = navpoint->input;
342
343 mutex_lock(&input->mutex);
344 if (input->users)
345 navpoint_up(navpoint);
346 mutex_unlock(&input->mutex);
347
348 return 0;
349}
350#endif
351
352static SIMPLE_DEV_PM_OPS(navpoint_pm_ops, navpoint_suspend, navpoint_resume);
353
354static struct platform_driver navpoint_driver = {
355 .probe = navpoint_probe,
356 .remove = __devexit_p(navpoint_remove),
357 .driver = {
358 .name = "navpoint",
359 .owner = THIS_MODULE,
360 .pm = &navpoint_pm_ops,
361 },
362};
363
364module_platform_driver(navpoint_driver);
365
366MODULE_AUTHOR("Paul Parsons <lost.distance@yahoo.com>");
367MODULE_DESCRIPTION("Synaptics NavPoint (PXA27x SSP/SPI) driver");
368MODULE_LICENSE("GPL");
369MODULE_ALIAS("platform:navpoint");