xref: /OK3568_Linux_fs/kernel/drivers/mfd/kempld-core.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-only
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun  * Kontron PLD MFD core driver
4*4882a593Smuzhiyun  *
5*4882a593Smuzhiyun  * Copyright (c) 2010-2013 Kontron Europe GmbH
6*4882a593Smuzhiyun  * Author: Michael Brunner <michael.brunner@kontron.com>
7*4882a593Smuzhiyun  */
8*4882a593Smuzhiyun 
9*4882a593Smuzhiyun #include <linux/platform_device.h>
10*4882a593Smuzhiyun #include <linux/mfd/core.h>
11*4882a593Smuzhiyun #include <linux/mfd/kempld.h>
12*4882a593Smuzhiyun #include <linux/module.h>
13*4882a593Smuzhiyun #include <linux/dmi.h>
14*4882a593Smuzhiyun #include <linux/io.h>
15*4882a593Smuzhiyun #include <linux/delay.h>
16*4882a593Smuzhiyun #include <linux/acpi.h>
17*4882a593Smuzhiyun 
18*4882a593Smuzhiyun #define MAX_ID_LEN 4
19*4882a593Smuzhiyun static char force_device_id[MAX_ID_LEN + 1] = "";
20*4882a593Smuzhiyun module_param_string(force_device_id, force_device_id,
21*4882a593Smuzhiyun 		    sizeof(force_device_id), 0);
22*4882a593Smuzhiyun MODULE_PARM_DESC(force_device_id, "Override detected product");
23*4882a593Smuzhiyun 
24*4882a593Smuzhiyun /*
25*4882a593Smuzhiyun  * Get hardware mutex to block firmware from accessing the pld.
26*4882a593Smuzhiyun  * It is possible for the firmware may hold the mutex for an extended length of
27*4882a593Smuzhiyun  * time. This function will block until access has been granted.
28*4882a593Smuzhiyun  */
kempld_get_hardware_mutex(struct kempld_device_data * pld)29*4882a593Smuzhiyun static void kempld_get_hardware_mutex(struct kempld_device_data *pld)
30*4882a593Smuzhiyun {
31*4882a593Smuzhiyun 	/* The mutex bit will read 1 until access has been granted */
32*4882a593Smuzhiyun 	while (ioread8(pld->io_index) & KEMPLD_MUTEX_KEY)
33*4882a593Smuzhiyun 		usleep_range(1000, 3000);
34*4882a593Smuzhiyun }
35*4882a593Smuzhiyun 
kempld_release_hardware_mutex(struct kempld_device_data * pld)36*4882a593Smuzhiyun static void kempld_release_hardware_mutex(struct kempld_device_data *pld)
37*4882a593Smuzhiyun {
38*4882a593Smuzhiyun 	/* The harware mutex is released when 1 is written to the mutex bit. */
39*4882a593Smuzhiyun 	iowrite8(KEMPLD_MUTEX_KEY, pld->io_index);
40*4882a593Smuzhiyun }
41*4882a593Smuzhiyun 
kempld_get_info_generic(struct kempld_device_data * pld)42*4882a593Smuzhiyun static int kempld_get_info_generic(struct kempld_device_data *pld)
43*4882a593Smuzhiyun {
44*4882a593Smuzhiyun 	u16 version;
45*4882a593Smuzhiyun 	u8 spec;
46*4882a593Smuzhiyun 
47*4882a593Smuzhiyun 	kempld_get_mutex(pld);
48*4882a593Smuzhiyun 
49*4882a593Smuzhiyun 	version = kempld_read16(pld, KEMPLD_VERSION);
50*4882a593Smuzhiyun 	spec = kempld_read8(pld, KEMPLD_SPEC);
51*4882a593Smuzhiyun 	pld->info.buildnr = kempld_read16(pld, KEMPLD_BUILDNR);
52*4882a593Smuzhiyun 
53*4882a593Smuzhiyun 	pld->info.minor = KEMPLD_VERSION_GET_MINOR(version);
54*4882a593Smuzhiyun 	pld->info.major = KEMPLD_VERSION_GET_MAJOR(version);
55*4882a593Smuzhiyun 	pld->info.number = KEMPLD_VERSION_GET_NUMBER(version);
56*4882a593Smuzhiyun 	pld->info.type = KEMPLD_VERSION_GET_TYPE(version);
57*4882a593Smuzhiyun 
58*4882a593Smuzhiyun 	if (spec == 0xff) {
59*4882a593Smuzhiyun 		pld->info.spec_minor = 0;
60*4882a593Smuzhiyun 		pld->info.spec_major = 1;
61*4882a593Smuzhiyun 	} else {
62*4882a593Smuzhiyun 		pld->info.spec_minor = KEMPLD_SPEC_GET_MINOR(spec);
63*4882a593Smuzhiyun 		pld->info.spec_major = KEMPLD_SPEC_GET_MAJOR(spec);
64*4882a593Smuzhiyun 	}
65*4882a593Smuzhiyun 
66*4882a593Smuzhiyun 	if (pld->info.spec_major > 0)
67*4882a593Smuzhiyun 		pld->feature_mask = kempld_read16(pld, KEMPLD_FEATURE);
68*4882a593Smuzhiyun 	else
69*4882a593Smuzhiyun 		pld->feature_mask = 0;
70*4882a593Smuzhiyun 
71*4882a593Smuzhiyun 	kempld_release_mutex(pld);
72*4882a593Smuzhiyun 
73*4882a593Smuzhiyun 	return 0;
74*4882a593Smuzhiyun }
75*4882a593Smuzhiyun 
76*4882a593Smuzhiyun enum kempld_cells {
77*4882a593Smuzhiyun 	KEMPLD_I2C = 0,
78*4882a593Smuzhiyun 	KEMPLD_WDT,
79*4882a593Smuzhiyun 	KEMPLD_GPIO,
80*4882a593Smuzhiyun 	KEMPLD_UART,
81*4882a593Smuzhiyun };
82*4882a593Smuzhiyun 
83*4882a593Smuzhiyun static const char *kempld_dev_names[] = {
84*4882a593Smuzhiyun 	[KEMPLD_I2C] = "kempld-i2c",
85*4882a593Smuzhiyun 	[KEMPLD_WDT] = "kempld-wdt",
86*4882a593Smuzhiyun 	[KEMPLD_GPIO] = "kempld-gpio",
87*4882a593Smuzhiyun 	[KEMPLD_UART] = "kempld-uart",
88*4882a593Smuzhiyun };
89*4882a593Smuzhiyun 
90*4882a593Smuzhiyun #define KEMPLD_MAX_DEVS	ARRAY_SIZE(kempld_dev_names)
91*4882a593Smuzhiyun 
kempld_register_cells_generic(struct kempld_device_data * pld)92*4882a593Smuzhiyun static int kempld_register_cells_generic(struct kempld_device_data *pld)
93*4882a593Smuzhiyun {
94*4882a593Smuzhiyun 	struct mfd_cell devs[KEMPLD_MAX_DEVS] = {};
95*4882a593Smuzhiyun 	int i = 0;
96*4882a593Smuzhiyun 
97*4882a593Smuzhiyun 	if (pld->feature_mask & KEMPLD_FEATURE_BIT_I2C)
98*4882a593Smuzhiyun 		devs[i++].name = kempld_dev_names[KEMPLD_I2C];
99*4882a593Smuzhiyun 
100*4882a593Smuzhiyun 	if (pld->feature_mask & KEMPLD_FEATURE_BIT_WATCHDOG)
101*4882a593Smuzhiyun 		devs[i++].name = kempld_dev_names[KEMPLD_WDT];
102*4882a593Smuzhiyun 
103*4882a593Smuzhiyun 	if (pld->feature_mask & KEMPLD_FEATURE_BIT_GPIO)
104*4882a593Smuzhiyun 		devs[i++].name = kempld_dev_names[KEMPLD_GPIO];
105*4882a593Smuzhiyun 
106*4882a593Smuzhiyun 	if (pld->feature_mask & KEMPLD_FEATURE_MASK_UART)
107*4882a593Smuzhiyun 		devs[i++].name = kempld_dev_names[KEMPLD_UART];
108*4882a593Smuzhiyun 
109*4882a593Smuzhiyun 	return mfd_add_devices(pld->dev, -1, devs, i, NULL, 0, NULL);
110*4882a593Smuzhiyun }
111*4882a593Smuzhiyun 
112*4882a593Smuzhiyun static struct resource kempld_ioresource = {
113*4882a593Smuzhiyun 	.start	= KEMPLD_IOINDEX,
114*4882a593Smuzhiyun 	.end	= KEMPLD_IODATA,
115*4882a593Smuzhiyun 	.flags	= IORESOURCE_IO,
116*4882a593Smuzhiyun };
117*4882a593Smuzhiyun 
118*4882a593Smuzhiyun static const struct kempld_platform_data kempld_platform_data_generic = {
119*4882a593Smuzhiyun 	.pld_clock		= KEMPLD_CLK,
120*4882a593Smuzhiyun 	.ioresource		= &kempld_ioresource,
121*4882a593Smuzhiyun 	.get_hardware_mutex	= kempld_get_hardware_mutex,
122*4882a593Smuzhiyun 	.release_hardware_mutex	= kempld_release_hardware_mutex,
123*4882a593Smuzhiyun 	.get_info		= kempld_get_info_generic,
124*4882a593Smuzhiyun 	.register_cells		= kempld_register_cells_generic,
125*4882a593Smuzhiyun };
126*4882a593Smuzhiyun 
127*4882a593Smuzhiyun static struct platform_device *kempld_pdev;
128*4882a593Smuzhiyun static bool kempld_acpi_mode;
129*4882a593Smuzhiyun 
kempld_create_platform_device(const struct dmi_system_id * id)130*4882a593Smuzhiyun static int kempld_create_platform_device(const struct dmi_system_id *id)
131*4882a593Smuzhiyun {
132*4882a593Smuzhiyun 	const struct kempld_platform_data *pdata = id->driver_data;
133*4882a593Smuzhiyun 	int ret;
134*4882a593Smuzhiyun 
135*4882a593Smuzhiyun 	kempld_pdev = platform_device_alloc("kempld", -1);
136*4882a593Smuzhiyun 	if (!kempld_pdev)
137*4882a593Smuzhiyun 		return -ENOMEM;
138*4882a593Smuzhiyun 
139*4882a593Smuzhiyun 	ret = platform_device_add_data(kempld_pdev, pdata, sizeof(*pdata));
140*4882a593Smuzhiyun 	if (ret)
141*4882a593Smuzhiyun 		goto err;
142*4882a593Smuzhiyun 
143*4882a593Smuzhiyun 	ret = platform_device_add_resources(kempld_pdev, pdata->ioresource, 1);
144*4882a593Smuzhiyun 	if (ret)
145*4882a593Smuzhiyun 		goto err;
146*4882a593Smuzhiyun 
147*4882a593Smuzhiyun 	ret = platform_device_add(kempld_pdev);
148*4882a593Smuzhiyun 	if (ret)
149*4882a593Smuzhiyun 		goto err;
150*4882a593Smuzhiyun 
151*4882a593Smuzhiyun 	return 0;
152*4882a593Smuzhiyun err:
153*4882a593Smuzhiyun 	platform_device_put(kempld_pdev);
154*4882a593Smuzhiyun 	return ret;
155*4882a593Smuzhiyun }
156*4882a593Smuzhiyun 
157*4882a593Smuzhiyun /**
158*4882a593Smuzhiyun  * kempld_read8 - read 8 bit register
159*4882a593Smuzhiyun  * @pld: kempld_device_data structure describing the PLD
160*4882a593Smuzhiyun  * @index: register index on the chip
161*4882a593Smuzhiyun  *
162*4882a593Smuzhiyun  * kempld_get_mutex must be called prior to calling this function.
163*4882a593Smuzhiyun  */
kempld_read8(struct kempld_device_data * pld,u8 index)164*4882a593Smuzhiyun u8 kempld_read8(struct kempld_device_data *pld, u8 index)
165*4882a593Smuzhiyun {
166*4882a593Smuzhiyun 	iowrite8(index, pld->io_index);
167*4882a593Smuzhiyun 	return ioread8(pld->io_data);
168*4882a593Smuzhiyun }
169*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(kempld_read8);
170*4882a593Smuzhiyun 
171*4882a593Smuzhiyun /**
172*4882a593Smuzhiyun  * kempld_write8 - write 8 bit register
173*4882a593Smuzhiyun  * @pld: kempld_device_data structure describing the PLD
174*4882a593Smuzhiyun  * @index: register index on the chip
175*4882a593Smuzhiyun  * @data: new register value
176*4882a593Smuzhiyun  *
177*4882a593Smuzhiyun  * kempld_get_mutex must be called prior to calling this function.
178*4882a593Smuzhiyun  */
kempld_write8(struct kempld_device_data * pld,u8 index,u8 data)179*4882a593Smuzhiyun void kempld_write8(struct kempld_device_data *pld, u8 index, u8 data)
180*4882a593Smuzhiyun {
181*4882a593Smuzhiyun 	iowrite8(index, pld->io_index);
182*4882a593Smuzhiyun 	iowrite8(data, pld->io_data);
183*4882a593Smuzhiyun }
184*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(kempld_write8);
185*4882a593Smuzhiyun 
186*4882a593Smuzhiyun /**
187*4882a593Smuzhiyun  * kempld_read16 - read 16 bit register
188*4882a593Smuzhiyun  * @pld: kempld_device_data structure describing the PLD
189*4882a593Smuzhiyun  * @index: register index on the chip
190*4882a593Smuzhiyun  *
191*4882a593Smuzhiyun  * kempld_get_mutex must be called prior to calling this function.
192*4882a593Smuzhiyun  */
kempld_read16(struct kempld_device_data * pld,u8 index)193*4882a593Smuzhiyun u16 kempld_read16(struct kempld_device_data *pld, u8 index)
194*4882a593Smuzhiyun {
195*4882a593Smuzhiyun 	return kempld_read8(pld, index) | kempld_read8(pld, index + 1) << 8;
196*4882a593Smuzhiyun }
197*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(kempld_read16);
198*4882a593Smuzhiyun 
199*4882a593Smuzhiyun /**
200*4882a593Smuzhiyun  * kempld_write16 - write 16 bit register
201*4882a593Smuzhiyun  * @pld: kempld_device_data structure describing the PLD
202*4882a593Smuzhiyun  * @index: register index on the chip
203*4882a593Smuzhiyun  * @data: new register value
204*4882a593Smuzhiyun  *
205*4882a593Smuzhiyun  * kempld_get_mutex must be called prior to calling this function.
206*4882a593Smuzhiyun  */
kempld_write16(struct kempld_device_data * pld,u8 index,u16 data)207*4882a593Smuzhiyun void kempld_write16(struct kempld_device_data *pld, u8 index, u16 data)
208*4882a593Smuzhiyun {
209*4882a593Smuzhiyun 	kempld_write8(pld, index, (u8)data);
210*4882a593Smuzhiyun 	kempld_write8(pld, index + 1, (u8)(data >> 8));
211*4882a593Smuzhiyun }
212*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(kempld_write16);
213*4882a593Smuzhiyun 
214*4882a593Smuzhiyun /**
215*4882a593Smuzhiyun  * kempld_read32 - read 32 bit register
216*4882a593Smuzhiyun  * @pld: kempld_device_data structure describing the PLD
217*4882a593Smuzhiyun  * @index: register index on the chip
218*4882a593Smuzhiyun  *
219*4882a593Smuzhiyun  * kempld_get_mutex must be called prior to calling this function.
220*4882a593Smuzhiyun  */
kempld_read32(struct kempld_device_data * pld,u8 index)221*4882a593Smuzhiyun u32 kempld_read32(struct kempld_device_data *pld, u8 index)
222*4882a593Smuzhiyun {
223*4882a593Smuzhiyun 	return kempld_read16(pld, index) | kempld_read16(pld, index + 2) << 16;
224*4882a593Smuzhiyun }
225*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(kempld_read32);
226*4882a593Smuzhiyun 
227*4882a593Smuzhiyun /**
228*4882a593Smuzhiyun  * kempld_write32 - write 32 bit register
229*4882a593Smuzhiyun  * @pld: kempld_device_data structure describing the PLD
230*4882a593Smuzhiyun  * @index: register index on the chip
231*4882a593Smuzhiyun  * @data: new register value
232*4882a593Smuzhiyun  *
233*4882a593Smuzhiyun  * kempld_get_mutex must be called prior to calling this function.
234*4882a593Smuzhiyun  */
kempld_write32(struct kempld_device_data * pld,u8 index,u32 data)235*4882a593Smuzhiyun void kempld_write32(struct kempld_device_data *pld, u8 index, u32 data)
236*4882a593Smuzhiyun {
237*4882a593Smuzhiyun 	kempld_write16(pld, index, (u16)data);
238*4882a593Smuzhiyun 	kempld_write16(pld, index + 2, (u16)(data >> 16));
239*4882a593Smuzhiyun }
240*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(kempld_write32);
241*4882a593Smuzhiyun 
242*4882a593Smuzhiyun /**
243*4882a593Smuzhiyun  * kempld_get_mutex - acquire PLD mutex
244*4882a593Smuzhiyun  * @pld: kempld_device_data structure describing the PLD
245*4882a593Smuzhiyun  */
kempld_get_mutex(struct kempld_device_data * pld)246*4882a593Smuzhiyun void kempld_get_mutex(struct kempld_device_data *pld)
247*4882a593Smuzhiyun {
248*4882a593Smuzhiyun 	const struct kempld_platform_data *pdata = dev_get_platdata(pld->dev);
249*4882a593Smuzhiyun 
250*4882a593Smuzhiyun 	mutex_lock(&pld->lock);
251*4882a593Smuzhiyun 	pdata->get_hardware_mutex(pld);
252*4882a593Smuzhiyun }
253*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(kempld_get_mutex);
254*4882a593Smuzhiyun 
255*4882a593Smuzhiyun /**
256*4882a593Smuzhiyun  * kempld_release_mutex - release PLD mutex
257*4882a593Smuzhiyun  * @pld: kempld_device_data structure describing the PLD
258*4882a593Smuzhiyun  */
kempld_release_mutex(struct kempld_device_data * pld)259*4882a593Smuzhiyun void kempld_release_mutex(struct kempld_device_data *pld)
260*4882a593Smuzhiyun {
261*4882a593Smuzhiyun 	const struct kempld_platform_data *pdata = dev_get_platdata(pld->dev);
262*4882a593Smuzhiyun 
263*4882a593Smuzhiyun 	pdata->release_hardware_mutex(pld);
264*4882a593Smuzhiyun 	mutex_unlock(&pld->lock);
265*4882a593Smuzhiyun }
266*4882a593Smuzhiyun EXPORT_SYMBOL_GPL(kempld_release_mutex);
267*4882a593Smuzhiyun 
268*4882a593Smuzhiyun /**
269*4882a593Smuzhiyun  * kempld_get_info - update device specific information
270*4882a593Smuzhiyun  * @pld: kempld_device_data structure describing the PLD
271*4882a593Smuzhiyun  *
272*4882a593Smuzhiyun  * This function calls the configured board specific kempld_get_info_XXXX
273*4882a593Smuzhiyun  * function which is responsible for gathering information about the specific
274*4882a593Smuzhiyun  * hardware. The information is then stored within the pld structure.
275*4882a593Smuzhiyun  */
kempld_get_info(struct kempld_device_data * pld)276*4882a593Smuzhiyun static int kempld_get_info(struct kempld_device_data *pld)
277*4882a593Smuzhiyun {
278*4882a593Smuzhiyun 	int ret;
279*4882a593Smuzhiyun 	const struct kempld_platform_data *pdata = dev_get_platdata(pld->dev);
280*4882a593Smuzhiyun 	char major, minor;
281*4882a593Smuzhiyun 
282*4882a593Smuzhiyun 	ret = pdata->get_info(pld);
283*4882a593Smuzhiyun 	if (ret)
284*4882a593Smuzhiyun 		return ret;
285*4882a593Smuzhiyun 
286*4882a593Smuzhiyun 	/* The Kontron PLD firmware version string has the following format:
287*4882a593Smuzhiyun 	 * Pwxy.zzzz
288*4882a593Smuzhiyun 	 *   P:    Fixed
289*4882a593Smuzhiyun 	 *   w:    PLD number    - 1 hex digit
290*4882a593Smuzhiyun 	 *   x:    Major version - 1 alphanumerical digit (0-9A-V)
291*4882a593Smuzhiyun 	 *   y:    Minor version - 1 alphanumerical digit (0-9A-V)
292*4882a593Smuzhiyun 	 *   zzzz: Build number  - 4 zero padded hex digits */
293*4882a593Smuzhiyun 
294*4882a593Smuzhiyun 	if (pld->info.major < 10)
295*4882a593Smuzhiyun 		major = pld->info.major + '0';
296*4882a593Smuzhiyun 	else
297*4882a593Smuzhiyun 		major = (pld->info.major - 10) + 'A';
298*4882a593Smuzhiyun 	if (pld->info.minor < 10)
299*4882a593Smuzhiyun 		minor = pld->info.minor + '0';
300*4882a593Smuzhiyun 	else
301*4882a593Smuzhiyun 		minor = (pld->info.minor - 10) + 'A';
302*4882a593Smuzhiyun 
303*4882a593Smuzhiyun 	ret = scnprintf(pld->info.version, sizeof(pld->info.version),
304*4882a593Smuzhiyun 			"P%X%c%c.%04X", pld->info.number, major, minor,
305*4882a593Smuzhiyun 			pld->info.buildnr);
306*4882a593Smuzhiyun 	if (ret < 0)
307*4882a593Smuzhiyun 		return ret;
308*4882a593Smuzhiyun 
309*4882a593Smuzhiyun 	return 0;
310*4882a593Smuzhiyun }
311*4882a593Smuzhiyun 
312*4882a593Smuzhiyun /*
313*4882a593Smuzhiyun  * kempld_register_cells - register cell drivers
314*4882a593Smuzhiyun  *
315*4882a593Smuzhiyun  * This function registers cell drivers for the detected hardware by calling
316*4882a593Smuzhiyun  * the configured kempld_register_cells_XXXX function which is responsible
317*4882a593Smuzhiyun  * to detect and register the needed cell drivers.
318*4882a593Smuzhiyun  */
kempld_register_cells(struct kempld_device_data * pld)319*4882a593Smuzhiyun static int kempld_register_cells(struct kempld_device_data *pld)
320*4882a593Smuzhiyun {
321*4882a593Smuzhiyun 	const struct kempld_platform_data *pdata = dev_get_platdata(pld->dev);
322*4882a593Smuzhiyun 
323*4882a593Smuzhiyun 	return pdata->register_cells(pld);
324*4882a593Smuzhiyun }
325*4882a593Smuzhiyun 
kempld_get_type_string(struct kempld_device_data * pld)326*4882a593Smuzhiyun static const char *kempld_get_type_string(struct kempld_device_data *pld)
327*4882a593Smuzhiyun {
328*4882a593Smuzhiyun 	const char *version_type;
329*4882a593Smuzhiyun 
330*4882a593Smuzhiyun 	switch (pld->info.type) {
331*4882a593Smuzhiyun 	case 0:
332*4882a593Smuzhiyun 		version_type = "release";
333*4882a593Smuzhiyun 		break;
334*4882a593Smuzhiyun 	case 1:
335*4882a593Smuzhiyun 		version_type = "debug";
336*4882a593Smuzhiyun 		break;
337*4882a593Smuzhiyun 	case 2:
338*4882a593Smuzhiyun 		version_type = "custom";
339*4882a593Smuzhiyun 		break;
340*4882a593Smuzhiyun 	default:
341*4882a593Smuzhiyun 		version_type = "unspecified";
342*4882a593Smuzhiyun 		break;
343*4882a593Smuzhiyun 	}
344*4882a593Smuzhiyun 
345*4882a593Smuzhiyun 	return version_type;
346*4882a593Smuzhiyun }
347*4882a593Smuzhiyun 
kempld_version_show(struct device * dev,struct device_attribute * attr,char * buf)348*4882a593Smuzhiyun static ssize_t kempld_version_show(struct device *dev,
349*4882a593Smuzhiyun 		struct device_attribute *attr, char *buf)
350*4882a593Smuzhiyun {
351*4882a593Smuzhiyun 	struct kempld_device_data *pld = dev_get_drvdata(dev);
352*4882a593Smuzhiyun 
353*4882a593Smuzhiyun 	return scnprintf(buf, PAGE_SIZE, "%s\n", pld->info.version);
354*4882a593Smuzhiyun }
355*4882a593Smuzhiyun 
kempld_specification_show(struct device * dev,struct device_attribute * attr,char * buf)356*4882a593Smuzhiyun static ssize_t kempld_specification_show(struct device *dev,
357*4882a593Smuzhiyun 		struct device_attribute *attr, char *buf)
358*4882a593Smuzhiyun {
359*4882a593Smuzhiyun 	struct kempld_device_data *pld = dev_get_drvdata(dev);
360*4882a593Smuzhiyun 
361*4882a593Smuzhiyun 	return scnprintf(buf, PAGE_SIZE, "%d.%d\n", pld->info.spec_major,
362*4882a593Smuzhiyun 		       pld->info.spec_minor);
363*4882a593Smuzhiyun }
364*4882a593Smuzhiyun 
kempld_type_show(struct device * dev,struct device_attribute * attr,char * buf)365*4882a593Smuzhiyun static ssize_t kempld_type_show(struct device *dev,
366*4882a593Smuzhiyun 		struct device_attribute *attr, char *buf)
367*4882a593Smuzhiyun {
368*4882a593Smuzhiyun 	struct kempld_device_data *pld = dev_get_drvdata(dev);
369*4882a593Smuzhiyun 
370*4882a593Smuzhiyun 	return scnprintf(buf, PAGE_SIZE, "%s\n", kempld_get_type_string(pld));
371*4882a593Smuzhiyun }
372*4882a593Smuzhiyun 
373*4882a593Smuzhiyun static DEVICE_ATTR(pld_version, S_IRUGO, kempld_version_show, NULL);
374*4882a593Smuzhiyun static DEVICE_ATTR(pld_specification, S_IRUGO, kempld_specification_show,
375*4882a593Smuzhiyun 		   NULL);
376*4882a593Smuzhiyun static DEVICE_ATTR(pld_type, S_IRUGO, kempld_type_show, NULL);
377*4882a593Smuzhiyun 
378*4882a593Smuzhiyun static struct attribute *pld_attributes[] = {
379*4882a593Smuzhiyun 	&dev_attr_pld_version.attr,
380*4882a593Smuzhiyun 	&dev_attr_pld_specification.attr,
381*4882a593Smuzhiyun 	&dev_attr_pld_type.attr,
382*4882a593Smuzhiyun 	NULL
383*4882a593Smuzhiyun };
384*4882a593Smuzhiyun 
385*4882a593Smuzhiyun static const struct attribute_group pld_attr_group = {
386*4882a593Smuzhiyun 	.attrs = pld_attributes,
387*4882a593Smuzhiyun };
388*4882a593Smuzhiyun 
kempld_detect_device(struct kempld_device_data * pld)389*4882a593Smuzhiyun static int kempld_detect_device(struct kempld_device_data *pld)
390*4882a593Smuzhiyun {
391*4882a593Smuzhiyun 	u8 index_reg;
392*4882a593Smuzhiyun 	int ret;
393*4882a593Smuzhiyun 
394*4882a593Smuzhiyun 	mutex_lock(&pld->lock);
395*4882a593Smuzhiyun 
396*4882a593Smuzhiyun 	/* Check for empty IO space */
397*4882a593Smuzhiyun 	index_reg = ioread8(pld->io_index);
398*4882a593Smuzhiyun 	if (index_reg == 0xff && ioread8(pld->io_data) == 0xff) {
399*4882a593Smuzhiyun 		mutex_unlock(&pld->lock);
400*4882a593Smuzhiyun 		return -ENODEV;
401*4882a593Smuzhiyun 	}
402*4882a593Smuzhiyun 
403*4882a593Smuzhiyun 	/* Release hardware mutex if acquired */
404*4882a593Smuzhiyun 	if (!(index_reg & KEMPLD_MUTEX_KEY)) {
405*4882a593Smuzhiyun 		iowrite8(KEMPLD_MUTEX_KEY, pld->io_index);
406*4882a593Smuzhiyun 		/* PXT and COMe-cPC2 boards may require a second release */
407*4882a593Smuzhiyun 		iowrite8(KEMPLD_MUTEX_KEY, pld->io_index);
408*4882a593Smuzhiyun 	}
409*4882a593Smuzhiyun 
410*4882a593Smuzhiyun 	mutex_unlock(&pld->lock);
411*4882a593Smuzhiyun 
412*4882a593Smuzhiyun 	ret = kempld_get_info(pld);
413*4882a593Smuzhiyun 	if (ret)
414*4882a593Smuzhiyun 		return ret;
415*4882a593Smuzhiyun 
416*4882a593Smuzhiyun 	dev_info(pld->dev, "Found Kontron PLD - %s (%s), spec %d.%d\n",
417*4882a593Smuzhiyun 		 pld->info.version, kempld_get_type_string(pld),
418*4882a593Smuzhiyun 		 pld->info.spec_major, pld->info.spec_minor);
419*4882a593Smuzhiyun 
420*4882a593Smuzhiyun 	ret = sysfs_create_group(&pld->dev->kobj, &pld_attr_group);
421*4882a593Smuzhiyun 	if (ret)
422*4882a593Smuzhiyun 		return ret;
423*4882a593Smuzhiyun 
424*4882a593Smuzhiyun 	ret = kempld_register_cells(pld);
425*4882a593Smuzhiyun 	if (ret)
426*4882a593Smuzhiyun 		sysfs_remove_group(&pld->dev->kobj, &pld_attr_group);
427*4882a593Smuzhiyun 
428*4882a593Smuzhiyun 	return ret;
429*4882a593Smuzhiyun }
430*4882a593Smuzhiyun 
431*4882a593Smuzhiyun #ifdef CONFIG_ACPI
kempld_get_acpi_data(struct platform_device * pdev)432*4882a593Smuzhiyun static int kempld_get_acpi_data(struct platform_device *pdev)
433*4882a593Smuzhiyun {
434*4882a593Smuzhiyun 	struct list_head resource_list;
435*4882a593Smuzhiyun 	struct resource *resources;
436*4882a593Smuzhiyun 	struct resource_entry *rentry;
437*4882a593Smuzhiyun 	struct device *dev = &pdev->dev;
438*4882a593Smuzhiyun 	struct acpi_device *acpi_dev = ACPI_COMPANION(dev);
439*4882a593Smuzhiyun 	const struct kempld_platform_data *pdata;
440*4882a593Smuzhiyun 	int ret;
441*4882a593Smuzhiyun 	int count;
442*4882a593Smuzhiyun 
443*4882a593Smuzhiyun 	pdata = acpi_device_get_match_data(dev);
444*4882a593Smuzhiyun 	ret = platform_device_add_data(pdev, pdata,
445*4882a593Smuzhiyun 				       sizeof(struct kempld_platform_data));
446*4882a593Smuzhiyun 	if (ret)
447*4882a593Smuzhiyun 		return ret;
448*4882a593Smuzhiyun 
449*4882a593Smuzhiyun 	INIT_LIST_HEAD(&resource_list);
450*4882a593Smuzhiyun 	ret = acpi_dev_get_resources(acpi_dev, &resource_list, NULL, NULL);
451*4882a593Smuzhiyun 	if (ret < 0)
452*4882a593Smuzhiyun 		goto out;
453*4882a593Smuzhiyun 
454*4882a593Smuzhiyun 	count = ret;
455*4882a593Smuzhiyun 
456*4882a593Smuzhiyun 	if (count == 0) {
457*4882a593Smuzhiyun 		ret = platform_device_add_resources(pdev, pdata->ioresource, 1);
458*4882a593Smuzhiyun 		goto out;
459*4882a593Smuzhiyun 	}
460*4882a593Smuzhiyun 
461*4882a593Smuzhiyun 	resources = devm_kcalloc(&acpi_dev->dev, count, sizeof(*resources),
462*4882a593Smuzhiyun 				 GFP_KERNEL);
463*4882a593Smuzhiyun 	if (!resources) {
464*4882a593Smuzhiyun 		ret = -ENOMEM;
465*4882a593Smuzhiyun 		goto out;
466*4882a593Smuzhiyun 	}
467*4882a593Smuzhiyun 
468*4882a593Smuzhiyun 	count = 0;
469*4882a593Smuzhiyun 	list_for_each_entry(rentry, &resource_list, node) {
470*4882a593Smuzhiyun 		memcpy(&resources[count], rentry->res,
471*4882a593Smuzhiyun 		       sizeof(*resources));
472*4882a593Smuzhiyun 		count++;
473*4882a593Smuzhiyun 	}
474*4882a593Smuzhiyun 	ret = platform_device_add_resources(pdev, resources, count);
475*4882a593Smuzhiyun 
476*4882a593Smuzhiyun out:
477*4882a593Smuzhiyun 	acpi_dev_free_resource_list(&resource_list);
478*4882a593Smuzhiyun 
479*4882a593Smuzhiyun 	return ret;
480*4882a593Smuzhiyun }
481*4882a593Smuzhiyun #else
kempld_get_acpi_data(struct platform_device * pdev)482*4882a593Smuzhiyun static int kempld_get_acpi_data(struct platform_device *pdev)
483*4882a593Smuzhiyun {
484*4882a593Smuzhiyun 	return -ENODEV;
485*4882a593Smuzhiyun }
486*4882a593Smuzhiyun #endif /* CONFIG_ACPI */
487*4882a593Smuzhiyun 
kempld_probe(struct platform_device * pdev)488*4882a593Smuzhiyun static int kempld_probe(struct platform_device *pdev)
489*4882a593Smuzhiyun {
490*4882a593Smuzhiyun 	const struct kempld_platform_data *pdata;
491*4882a593Smuzhiyun 	struct device *dev = &pdev->dev;
492*4882a593Smuzhiyun 	struct kempld_device_data *pld;
493*4882a593Smuzhiyun 	struct resource *ioport;
494*4882a593Smuzhiyun 	int ret;
495*4882a593Smuzhiyun 
496*4882a593Smuzhiyun 	if (kempld_pdev == NULL) {
497*4882a593Smuzhiyun 		/*
498*4882a593Smuzhiyun 		 * No kempld_pdev device has been registered in kempld_init,
499*4882a593Smuzhiyun 		 * so we seem to be probing an ACPI platform device.
500*4882a593Smuzhiyun 		 */
501*4882a593Smuzhiyun 		ret = kempld_get_acpi_data(pdev);
502*4882a593Smuzhiyun 		if (ret)
503*4882a593Smuzhiyun 			return ret;
504*4882a593Smuzhiyun 
505*4882a593Smuzhiyun 		kempld_acpi_mode = true;
506*4882a593Smuzhiyun 	} else if (kempld_pdev != pdev) {
507*4882a593Smuzhiyun 		/*
508*4882a593Smuzhiyun 		 * The platform device we are probing is not the one we
509*4882a593Smuzhiyun 		 * registered in kempld_init using the DMI table, so this one
510*4882a593Smuzhiyun 		 * comes from ACPI.
511*4882a593Smuzhiyun 		 * As we can only probe one - abort here and use the DMI
512*4882a593Smuzhiyun 		 * based one instead.
513*4882a593Smuzhiyun 		 */
514*4882a593Smuzhiyun 		dev_notice(dev, "platform device exists - not using ACPI\n");
515*4882a593Smuzhiyun 		return -ENODEV;
516*4882a593Smuzhiyun 	}
517*4882a593Smuzhiyun 	pdata = dev_get_platdata(dev);
518*4882a593Smuzhiyun 
519*4882a593Smuzhiyun 	pld = devm_kzalloc(dev, sizeof(*pld), GFP_KERNEL);
520*4882a593Smuzhiyun 	if (!pld)
521*4882a593Smuzhiyun 		return -ENOMEM;
522*4882a593Smuzhiyun 
523*4882a593Smuzhiyun 	ioport = platform_get_resource(pdev, IORESOURCE_IO, 0);
524*4882a593Smuzhiyun 	if (!ioport)
525*4882a593Smuzhiyun 		return -EINVAL;
526*4882a593Smuzhiyun 
527*4882a593Smuzhiyun 	pld->io_base = devm_ioport_map(dev, ioport->start,
528*4882a593Smuzhiyun 					resource_size(ioport));
529*4882a593Smuzhiyun 	if (!pld->io_base)
530*4882a593Smuzhiyun 		return -ENOMEM;
531*4882a593Smuzhiyun 
532*4882a593Smuzhiyun 	pld->io_index = pld->io_base;
533*4882a593Smuzhiyun 	pld->io_data = pld->io_base + 1;
534*4882a593Smuzhiyun 	pld->pld_clock = pdata->pld_clock;
535*4882a593Smuzhiyun 	pld->dev = dev;
536*4882a593Smuzhiyun 
537*4882a593Smuzhiyun 	mutex_init(&pld->lock);
538*4882a593Smuzhiyun 	platform_set_drvdata(pdev, pld);
539*4882a593Smuzhiyun 
540*4882a593Smuzhiyun 	return kempld_detect_device(pld);
541*4882a593Smuzhiyun }
542*4882a593Smuzhiyun 
kempld_remove(struct platform_device * pdev)543*4882a593Smuzhiyun static int kempld_remove(struct platform_device *pdev)
544*4882a593Smuzhiyun {
545*4882a593Smuzhiyun 	struct kempld_device_data *pld = platform_get_drvdata(pdev);
546*4882a593Smuzhiyun 	const struct kempld_platform_data *pdata = dev_get_platdata(pld->dev);
547*4882a593Smuzhiyun 
548*4882a593Smuzhiyun 	sysfs_remove_group(&pld->dev->kobj, &pld_attr_group);
549*4882a593Smuzhiyun 
550*4882a593Smuzhiyun 	mfd_remove_devices(&pdev->dev);
551*4882a593Smuzhiyun 	pdata->release_hardware_mutex(pld);
552*4882a593Smuzhiyun 
553*4882a593Smuzhiyun 	return 0;
554*4882a593Smuzhiyun }
555*4882a593Smuzhiyun 
556*4882a593Smuzhiyun #ifdef CONFIG_ACPI
557*4882a593Smuzhiyun static const struct acpi_device_id kempld_acpi_table[] = {
558*4882a593Smuzhiyun 	{ "KEM0001", (kernel_ulong_t)&kempld_platform_data_generic },
559*4882a593Smuzhiyun 	{}
560*4882a593Smuzhiyun };
561*4882a593Smuzhiyun MODULE_DEVICE_TABLE(acpi, kempld_acpi_table);
562*4882a593Smuzhiyun #endif
563*4882a593Smuzhiyun 
564*4882a593Smuzhiyun static struct platform_driver kempld_driver = {
565*4882a593Smuzhiyun 	.driver		= {
566*4882a593Smuzhiyun 		.name	= "kempld",
567*4882a593Smuzhiyun 		.acpi_match_table = ACPI_PTR(kempld_acpi_table),
568*4882a593Smuzhiyun 		.probe_type = PROBE_FORCE_SYNCHRONOUS,
569*4882a593Smuzhiyun 	},
570*4882a593Smuzhiyun 	.probe		= kempld_probe,
571*4882a593Smuzhiyun 	.remove		= kempld_remove,
572*4882a593Smuzhiyun };
573*4882a593Smuzhiyun 
574*4882a593Smuzhiyun static const struct dmi_system_id kempld_dmi_table[] __initconst = {
575*4882a593Smuzhiyun 	{
576*4882a593Smuzhiyun 		.ident = "BBD6",
577*4882a593Smuzhiyun 		.matches = {
578*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_VENDOR, "Kontron"),
579*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_NAME, "COMe-bBD"),
580*4882a593Smuzhiyun 		},
581*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
582*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
583*4882a593Smuzhiyun 	}, {
584*4882a593Smuzhiyun 		.ident = "BBL6",
585*4882a593Smuzhiyun 		.matches = {
586*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_VENDOR, "Kontron"),
587*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_NAME, "COMe-bBL6"),
588*4882a593Smuzhiyun 		},
589*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
590*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
591*4882a593Smuzhiyun 	}, {
592*4882a593Smuzhiyun 		.ident = "BHL6",
593*4882a593Smuzhiyun 		.matches = {
594*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_VENDOR, "Kontron"),
595*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_NAME, "COMe-bHL6"),
596*4882a593Smuzhiyun 		},
597*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
598*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
599*4882a593Smuzhiyun 	}, {
600*4882a593Smuzhiyun 		.ident = "BKL6",
601*4882a593Smuzhiyun 		.matches = {
602*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_VENDOR, "Kontron"),
603*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_NAME, "COMe-bKL6"),
604*4882a593Smuzhiyun 		},
605*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
606*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
607*4882a593Smuzhiyun 	}, {
608*4882a593Smuzhiyun 		.ident = "BSL6",
609*4882a593Smuzhiyun 		.matches = {
610*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_VENDOR, "Kontron"),
611*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_NAME, "COMe-bSL6"),
612*4882a593Smuzhiyun 		},
613*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
614*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
615*4882a593Smuzhiyun 	}, {
616*4882a593Smuzhiyun 		.ident = "CAL6",
617*4882a593Smuzhiyun 		.matches = {
618*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_VENDOR, "Kontron"),
619*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_NAME, "COMe-cAL"),
620*4882a593Smuzhiyun 		},
621*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
622*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
623*4882a593Smuzhiyun 	}, {
624*4882a593Smuzhiyun 		.ident = "CBL6",
625*4882a593Smuzhiyun 		.matches = {
626*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_VENDOR, "Kontron"),
627*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_NAME, "COMe-cBL6"),
628*4882a593Smuzhiyun 		},
629*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
630*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
631*4882a593Smuzhiyun 	}, {
632*4882a593Smuzhiyun 		.ident = "CBW6",
633*4882a593Smuzhiyun 		.matches = {
634*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_VENDOR, "Kontron"),
635*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_NAME, "COMe-cBW6"),
636*4882a593Smuzhiyun 		},
637*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
638*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
639*4882a593Smuzhiyun 	}, {
640*4882a593Smuzhiyun 		.ident = "CCR2",
641*4882a593Smuzhiyun 		.matches = {
642*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_VENDOR, "Kontron"),
643*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_NAME, "COMe-bIP2"),
644*4882a593Smuzhiyun 		},
645*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
646*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
647*4882a593Smuzhiyun 	}, {
648*4882a593Smuzhiyun 		.ident = "CCR6",
649*4882a593Smuzhiyun 		.matches = {
650*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_VENDOR, "Kontron"),
651*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_NAME, "COMe-bIP6"),
652*4882a593Smuzhiyun 		},
653*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
654*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
655*4882a593Smuzhiyun 	}, {
656*4882a593Smuzhiyun 		.ident = "CHL6",
657*4882a593Smuzhiyun 		.matches = {
658*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_VENDOR, "Kontron"),
659*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_NAME, "COMe-cHL6"),
660*4882a593Smuzhiyun 		},
661*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
662*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
663*4882a593Smuzhiyun 	}, {
664*4882a593Smuzhiyun 		.ident = "CHR2",
665*4882a593Smuzhiyun 		.matches = {
666*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_VENDOR, "Kontron"),
667*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_NAME, "ETXexpress-SC T2"),
668*4882a593Smuzhiyun 		},
669*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
670*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
671*4882a593Smuzhiyun 	}, {
672*4882a593Smuzhiyun 		.ident = "CHR2",
673*4882a593Smuzhiyun 		.matches = {
674*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_VENDOR, "Kontron"),
675*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_NAME, "ETXe-SC T2"),
676*4882a593Smuzhiyun 		},
677*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
678*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
679*4882a593Smuzhiyun 	}, {
680*4882a593Smuzhiyun 		.ident = "CHR2",
681*4882a593Smuzhiyun 		.matches = {
682*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_VENDOR, "Kontron"),
683*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_NAME, "COMe-bSC2"),
684*4882a593Smuzhiyun 		},
685*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
686*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
687*4882a593Smuzhiyun 	}, {
688*4882a593Smuzhiyun 		.ident = "CHR6",
689*4882a593Smuzhiyun 		.matches = {
690*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_VENDOR, "Kontron"),
691*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_NAME, "ETXexpress-SC T6"),
692*4882a593Smuzhiyun 		},
693*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
694*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
695*4882a593Smuzhiyun 	}, {
696*4882a593Smuzhiyun 		.ident = "CHR6",
697*4882a593Smuzhiyun 		.matches = {
698*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_VENDOR, "Kontron"),
699*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_NAME, "ETXe-SC T6"),
700*4882a593Smuzhiyun 		},
701*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
702*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
703*4882a593Smuzhiyun 	}, {
704*4882a593Smuzhiyun 		.ident = "CHR6",
705*4882a593Smuzhiyun 		.matches = {
706*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_VENDOR, "Kontron"),
707*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_NAME, "COMe-bSC6"),
708*4882a593Smuzhiyun 		},
709*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
710*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
711*4882a593Smuzhiyun 	}, {
712*4882a593Smuzhiyun 		.ident = "CKL6",
713*4882a593Smuzhiyun 		.matches = {
714*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_VENDOR, "Kontron"),
715*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_NAME, "COMe-cKL6"),
716*4882a593Smuzhiyun 		},
717*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
718*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
719*4882a593Smuzhiyun 	}, {
720*4882a593Smuzhiyun 		.ident = "CNTG",
721*4882a593Smuzhiyun 		.matches = {
722*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_VENDOR, "Kontron"),
723*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_NAME, "ETXexpress-PC"),
724*4882a593Smuzhiyun 		},
725*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
726*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
727*4882a593Smuzhiyun 	}, {
728*4882a593Smuzhiyun 		.ident = "CNTG",
729*4882a593Smuzhiyun 		.matches = {
730*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_VENDOR, "Kontron"),
731*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_NAME, "COMe-bPC2"),
732*4882a593Smuzhiyun 		},
733*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
734*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
735*4882a593Smuzhiyun 	}, {
736*4882a593Smuzhiyun 		.ident = "CNTX",
737*4882a593Smuzhiyun 		.matches = {
738*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_VENDOR, "Kontron"),
739*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_NAME, "PXT"),
740*4882a593Smuzhiyun 		},
741*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
742*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
743*4882a593Smuzhiyun 	}, {
744*4882a593Smuzhiyun 		.ident = "CSL6",
745*4882a593Smuzhiyun 		.matches = {
746*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_VENDOR, "Kontron"),
747*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_NAME, "COMe-cSL6"),
748*4882a593Smuzhiyun 		},
749*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
750*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
751*4882a593Smuzhiyun 	}, {
752*4882a593Smuzhiyun 		.ident = "CVV6",
753*4882a593Smuzhiyun 		.matches = {
754*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_VENDOR, "Kontron"),
755*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_NAME, "COMe-cBT"),
756*4882a593Smuzhiyun 		},
757*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
758*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
759*4882a593Smuzhiyun 	}, {
760*4882a593Smuzhiyun 		.ident = "FRI2",
761*4882a593Smuzhiyun 		.matches = {
762*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_VENDOR, "Kontron"),
763*4882a593Smuzhiyun 			DMI_MATCH(DMI_BIOS_VERSION, "FRI2"),
764*4882a593Smuzhiyun 		},
765*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
766*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
767*4882a593Smuzhiyun 	}, {
768*4882a593Smuzhiyun 		.ident = "FRI2",
769*4882a593Smuzhiyun 		.matches = {
770*4882a593Smuzhiyun 			DMI_MATCH(DMI_PRODUCT_NAME, "Fish River Island II"),
771*4882a593Smuzhiyun 		},
772*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
773*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
774*4882a593Smuzhiyun 	}, {
775*4882a593Smuzhiyun 		.ident = "MAL1",
776*4882a593Smuzhiyun 		.matches = {
777*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_VENDOR, "Kontron"),
778*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_NAME, "COMe-mAL10"),
779*4882a593Smuzhiyun 		},
780*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
781*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
782*4882a593Smuzhiyun 	}, {
783*4882a593Smuzhiyun 		.ident = "MBR1",
784*4882a593Smuzhiyun 		.matches = {
785*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_VENDOR, "Kontron"),
786*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_NAME, "ETX-OH"),
787*4882a593Smuzhiyun 		},
788*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
789*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
790*4882a593Smuzhiyun 	}, {
791*4882a593Smuzhiyun 		.ident = "MVV1",
792*4882a593Smuzhiyun 		.matches = {
793*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_VENDOR, "Kontron"),
794*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_NAME, "COMe-mBT"),
795*4882a593Smuzhiyun 		},
796*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
797*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
798*4882a593Smuzhiyun 	}, {
799*4882a593Smuzhiyun 		.ident = "NTC1",
800*4882a593Smuzhiyun 		.matches = {
801*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_VENDOR, "Kontron"),
802*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_NAME, "nanoETXexpress-TT"),
803*4882a593Smuzhiyun 		},
804*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
805*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
806*4882a593Smuzhiyun 	}, {
807*4882a593Smuzhiyun 		.ident = "NTC1",
808*4882a593Smuzhiyun 		.matches = {
809*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_VENDOR, "Kontron"),
810*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_NAME, "nETXe-TT"),
811*4882a593Smuzhiyun 		},
812*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
813*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
814*4882a593Smuzhiyun 	}, {
815*4882a593Smuzhiyun 		.ident = "NTC1",
816*4882a593Smuzhiyun 		.matches = {
817*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_VENDOR, "Kontron"),
818*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_NAME, "COMe-mTT"),
819*4882a593Smuzhiyun 		},
820*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
821*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
822*4882a593Smuzhiyun 	}, {
823*4882a593Smuzhiyun 		.ident = "NUP1",
824*4882a593Smuzhiyun 		.matches = {
825*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_VENDOR, "Kontron"),
826*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_NAME, "COMe-mCT"),
827*4882a593Smuzhiyun 		},
828*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
829*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
830*4882a593Smuzhiyun 	}, {
831*4882a593Smuzhiyun 		.ident = "UNP1",
832*4882a593Smuzhiyun 		.matches = {
833*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_VENDOR, "Kontron"),
834*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_NAME, "microETXexpress-DC"),
835*4882a593Smuzhiyun 		},
836*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
837*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
838*4882a593Smuzhiyun 	}, {
839*4882a593Smuzhiyun 		.ident = "UNP1",
840*4882a593Smuzhiyun 		.matches = {
841*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_VENDOR, "Kontron"),
842*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_NAME, "COMe-cDC2"),
843*4882a593Smuzhiyun 		},
844*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
845*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
846*4882a593Smuzhiyun 	}, {
847*4882a593Smuzhiyun 		.ident = "UNTG",
848*4882a593Smuzhiyun 		.matches = {
849*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_VENDOR, "Kontron"),
850*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_NAME, "microETXexpress-PC"),
851*4882a593Smuzhiyun 		},
852*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
853*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
854*4882a593Smuzhiyun 	}, {
855*4882a593Smuzhiyun 		.ident = "UNTG",
856*4882a593Smuzhiyun 		.matches = {
857*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_VENDOR, "Kontron"),
858*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_NAME, "COMe-cPC2"),
859*4882a593Smuzhiyun 		},
860*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
861*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
862*4882a593Smuzhiyun 	}, {
863*4882a593Smuzhiyun 		.ident = "UUP6",
864*4882a593Smuzhiyun 		.matches = {
865*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_VENDOR, "Kontron"),
866*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_NAME, "COMe-cCT6"),
867*4882a593Smuzhiyun 		},
868*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
869*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
870*4882a593Smuzhiyun 	},
871*4882a593Smuzhiyun 	{
872*4882a593Smuzhiyun 		.ident = "UTH6",
873*4882a593Smuzhiyun 		.matches = {
874*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_VENDOR, "Kontron"),
875*4882a593Smuzhiyun 			DMI_MATCH(DMI_BOARD_NAME, "COMe-cTH6"),
876*4882a593Smuzhiyun 		},
877*4882a593Smuzhiyun 		.driver_data = (void *)&kempld_platform_data_generic,
878*4882a593Smuzhiyun 		.callback = kempld_create_platform_device,
879*4882a593Smuzhiyun 	},
880*4882a593Smuzhiyun 	{}
881*4882a593Smuzhiyun };
882*4882a593Smuzhiyun MODULE_DEVICE_TABLE(dmi, kempld_dmi_table);
883*4882a593Smuzhiyun 
kempld_init(void)884*4882a593Smuzhiyun static int __init kempld_init(void)
885*4882a593Smuzhiyun {
886*4882a593Smuzhiyun 	const struct dmi_system_id *id;
887*4882a593Smuzhiyun 	int ret;
888*4882a593Smuzhiyun 
889*4882a593Smuzhiyun 	if (force_device_id[0]) {
890*4882a593Smuzhiyun 		for (id = kempld_dmi_table;
891*4882a593Smuzhiyun 		     id->matches[0].slot != DMI_NONE; id++)
892*4882a593Smuzhiyun 			if (strstr(id->ident, force_device_id))
893*4882a593Smuzhiyun 				if (id->callback && !id->callback(id))
894*4882a593Smuzhiyun 					break;
895*4882a593Smuzhiyun 		if (id->matches[0].slot == DMI_NONE)
896*4882a593Smuzhiyun 			return -ENODEV;
897*4882a593Smuzhiyun 	}
898*4882a593Smuzhiyun 
899*4882a593Smuzhiyun 	ret = platform_driver_register(&kempld_driver);
900*4882a593Smuzhiyun 	if (ret)
901*4882a593Smuzhiyun 		return ret;
902*4882a593Smuzhiyun 
903*4882a593Smuzhiyun 	/*
904*4882a593Smuzhiyun 	 * With synchronous probing the device should already be probed now.
905*4882a593Smuzhiyun 	 * If no device id is forced and also no ACPI definition for the
906*4882a593Smuzhiyun 	 * device was found, scan DMI table as fallback.
907*4882a593Smuzhiyun 	 *
908*4882a593Smuzhiyun 	 * If drivers_autoprobing is disabled and the device is found here,
909*4882a593Smuzhiyun 	 * only that device can be bound manually later.
910*4882a593Smuzhiyun 	 */
911*4882a593Smuzhiyun 	if (!kempld_pdev && !kempld_acpi_mode)
912*4882a593Smuzhiyun 		dmi_check_system(kempld_dmi_table);
913*4882a593Smuzhiyun 
914*4882a593Smuzhiyun 	return 0;
915*4882a593Smuzhiyun }
916*4882a593Smuzhiyun 
kempld_exit(void)917*4882a593Smuzhiyun static void __exit kempld_exit(void)
918*4882a593Smuzhiyun {
919*4882a593Smuzhiyun 	if (kempld_pdev)
920*4882a593Smuzhiyun 		platform_device_unregister(kempld_pdev);
921*4882a593Smuzhiyun 
922*4882a593Smuzhiyun 	platform_driver_unregister(&kempld_driver);
923*4882a593Smuzhiyun }
924*4882a593Smuzhiyun 
925*4882a593Smuzhiyun module_init(kempld_init);
926*4882a593Smuzhiyun module_exit(kempld_exit);
927*4882a593Smuzhiyun 
928*4882a593Smuzhiyun MODULE_DESCRIPTION("KEM PLD Core Driver");
929*4882a593Smuzhiyun MODULE_AUTHOR("Michael Brunner <michael.brunner@kontron.com>");
930*4882a593Smuzhiyun MODULE_LICENSE("GPL");
931*4882a593Smuzhiyun MODULE_ALIAS("platform:kempld-core");
932