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