1// SPDX-License-Identifier: GPL-2.0-only
2/*
3 * Core functions for:
4 *  Philips UCB1400 multifunction chip
5 *
6 * Based on ucb1400_ts.c:
7 *  Author:	Nicolas Pitre
8 *  Created:	September 25, 2006
9 *  Copyright:	MontaVista Software, Inc.
10 *
11 * Spliting done by: Marek Vasut <marek.vasut@gmail.com>
12 * If something doesn't work and it worked before spliting, e-mail me,
13 * dont bother Nicolas please ;-)
14 *
15 * This code is heavily based on ucb1x00-*.c copyrighted by Russell King
16 * covering the UCB1100, UCB1200 and UCB1300..  Support for the UCB1400 has
17 * been made separate from ucb1x00-core/ucb1x00-ts on Russell's request.
18 */
19
20#include <linux/module.h>
21#include <linux/sched.h>
22#include <linux/slab.h>
23#include <linux/ucb1400.h>
24
25unsigned int ucb1400_adc_read(struct snd_ac97 *ac97, u16 adc_channel,
26		int adcsync)
27{
28	unsigned int val;
29
30	if (adcsync)
31		adc_channel |= UCB_ADC_SYNC_ENA;
32
33	ucb1400_reg_write(ac97, UCB_ADC_CR, UCB_ADC_ENA | adc_channel);
34	ucb1400_reg_write(ac97, UCB_ADC_CR, UCB_ADC_ENA | adc_channel |
35			UCB_ADC_START);
36
37	while (!((val = ucb1400_reg_read(ac97, UCB_ADC_DATA))
38				& UCB_ADC_DAT_VALID))
39		schedule_timeout_uninterruptible(1);
40
41	return val & UCB_ADC_DAT_MASK;
42}
43EXPORT_SYMBOL_GPL(ucb1400_adc_read);
44
45static int ucb1400_core_probe(struct device *dev)
46{
47	int err;
48	struct ucb1400 *ucb;
49	struct ucb1400_ts ucb_ts;
50	struct ucb1400_gpio ucb_gpio;
51	struct snd_ac97 *ac97;
52	struct ucb1400_pdata *pdata = dev_get_platdata(dev);
53
54	memset(&ucb_ts, 0, sizeof(ucb_ts));
55	memset(&ucb_gpio, 0, sizeof(ucb_gpio));
56
57	ucb = kzalloc(sizeof(struct ucb1400), GFP_KERNEL);
58	if (!ucb) {
59		err = -ENOMEM;
60		goto err;
61	}
62
63	dev_set_drvdata(dev, ucb);
64
65	ac97 = to_ac97_t(dev);
66
67	ucb_ts.id = ucb1400_reg_read(ac97, UCB_ID);
68	if (ucb_ts.id != UCB_ID_1400) {
69		err = -ENODEV;
70		goto err0;
71	}
72
73	/* GPIO */
74	ucb_gpio.ac97 = ac97;
75	if (pdata) {
76		ucb_gpio.gpio_setup = pdata->gpio_setup;
77		ucb_gpio.gpio_teardown = pdata->gpio_teardown;
78		ucb_gpio.gpio_offset = pdata->gpio_offset;
79	}
80	ucb->ucb1400_gpio = platform_device_alloc("ucb1400_gpio", -1);
81	if (!ucb->ucb1400_gpio) {
82		err = -ENOMEM;
83		goto err0;
84	}
85	err = platform_device_add_data(ucb->ucb1400_gpio, &ucb_gpio,
86					sizeof(ucb_gpio));
87	if (err)
88		goto err1;
89	err = platform_device_add(ucb->ucb1400_gpio);
90	if (err)
91		goto err1;
92
93	/* TOUCHSCREEN */
94	ucb_ts.ac97 = ac97;
95
96	if (pdata != NULL && pdata->irq >= 0)
97		ucb_ts.irq = pdata->irq;
98	else
99		ucb_ts.irq = -1;
100
101	ucb->ucb1400_ts = platform_device_alloc("ucb1400_ts", -1);
102	if (!ucb->ucb1400_ts) {
103		err = -ENOMEM;
104		goto err2;
105	}
106	err = platform_device_add_data(ucb->ucb1400_ts, &ucb_ts,
107					sizeof(ucb_ts));
108	if (err)
109		goto err3;
110	err = platform_device_add(ucb->ucb1400_ts);
111	if (err)
112		goto err3;
113
114	return 0;
115
116err3:
117	platform_device_put(ucb->ucb1400_ts);
118err2:
119	platform_device_del(ucb->ucb1400_gpio);
120err1:
121	platform_device_put(ucb->ucb1400_gpio);
122err0:
123	kfree(ucb);
124err:
125	return err;
126}
127
128static int ucb1400_core_remove(struct device *dev)
129{
130	struct ucb1400 *ucb = dev_get_drvdata(dev);
131
132	platform_device_unregister(ucb->ucb1400_ts);
133	platform_device_unregister(ucb->ucb1400_gpio);
134
135	kfree(ucb);
136	return 0;
137}
138
139static struct device_driver ucb1400_core_driver = {
140	.name	= "ucb1400_core",
141	.bus	= &ac97_bus_type,
142	.probe	= ucb1400_core_probe,
143	.remove	= ucb1400_core_remove,
144};
145
146static int __init ucb1400_core_init(void)
147{
148	return driver_register(&ucb1400_core_driver);
149}
150
151static void __exit ucb1400_core_exit(void)
152{
153	driver_unregister(&ucb1400_core_driver);
154}
155
156module_init(ucb1400_core_init);
157module_exit(ucb1400_core_exit);
158
159MODULE_DESCRIPTION("Philips UCB1400 driver");
160MODULE_LICENSE("GPL");
161