Blame view

drivers/bus/hisi_lpc.c 18 KB
adf38bb0b   Zhichang Yuan   HISI LPC: Support...
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
  // SPDX-License-Identifier: GPL-2.0+
  /*
   * Copyright (C) 2017 Hisilicon Limited, All Rights Reserved.
   * Author: Zhichang Yuan <yuanzhichang@hisilicon.com>
   * Author: Zou Rongrong <zourongrong@huawei.com>
   * Author: John Garry <john.garry@huawei.com>
   */
  
  #include <linux/acpi.h>
  #include <linux/console.h>
  #include <linux/delay.h>
  #include <linux/io.h>
  #include <linux/logic_pio.h>
  #include <linux/module.h>
  #include <linux/of.h>
  #include <linux/of_address.h>
  #include <linux/of_platform.h>
  #include <linux/pci.h>
adf3457b4   John Garry   HISI LPC: Add ACP...
19
  #include <linux/serial_8250.h>
adf38bb0b   Zhichang Yuan   HISI LPC: Support...
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
307
308
309
310
311
312
313
314
315
316
317
318
319
320
321
322
323
324
325
326
327
328
329
330
331
332
333
334
335
336
337
338
339
340
341
  #include <linux/slab.h>
  
  #define DRV_NAME "hisi-lpc"
  
  /*
   * Setting this bit means each IO operation will target a different port
   * address; 0 means repeated IO operations will use the same port,
   * such as BT.
   */
  #define FG_INCRADDR_LPC		0x02
  
  struct lpc_cycle_para {
  	unsigned int opflags;
  	unsigned int csize; /* data length of each operation */
  };
  
  struct hisi_lpc_dev {
  	spinlock_t cycle_lock;
  	void __iomem  *membase;
  	struct logic_pio_hwaddr *io_host;
  };
  
  /* The max IO cycle counts supported is four per operation at maximum */
  #define LPC_MAX_DWIDTH	4
  
  #define LPC_REG_STARTUP_SIGNAL		0x00
  #define LPC_REG_STARTUP_SIGNAL_START	BIT(0)
  #define LPC_REG_OP_STATUS		0x04
  #define LPC_REG_OP_STATUS_IDLE		BIT(0)
  #define LPC_REG_OP_STATUS_FINISHED	BIT(1)
  #define LPC_REG_OP_LEN			0x10 /* LPC cycles count per start */
  #define LPC_REG_CMD			0x14
  #define LPC_REG_CMD_OP			BIT(0) /* 0: read, 1: write */
  #define LPC_REG_CMD_SAMEADDR		BIT(3)
  #define LPC_REG_ADDR			0x20 /* target address */
  #define LPC_REG_WDATA			0x24 /* write FIFO */
  #define LPC_REG_RDATA			0x28 /* read FIFO */
  
  /* The minimal nanosecond interval for each query on LPC cycle status */
  #define LPC_NSEC_PERWAIT	100
  
  /*
   * The maximum waiting time is about 128us.  It is specific for stream I/O,
   * such as ins.
   *
   * The fastest IO cycle time is about 390ns, but the worst case will wait
   * for extra 256 lpc clocks, so (256 + 13) * 30ns = 8 us. The maximum burst
   * cycles is 16. So, the maximum waiting time is about 128us under worst
   * case.
   *
   * Choose 1300 as the maximum.
   */
  #define LPC_MAX_WAITCNT		1300
  
  /* About 10us. This is specific for single IO operations, such as inb */
  #define LPC_PEROP_WAITCNT	100
  
  static int wait_lpc_idle(unsigned char *mbase, unsigned int waitcnt)
  {
  	u32 status;
  
  	do {
  		status = readl(mbase + LPC_REG_OP_STATUS);
  		if (status & LPC_REG_OP_STATUS_IDLE)
  			return (status & LPC_REG_OP_STATUS_FINISHED) ? 0 : -EIO;
  		ndelay(LPC_NSEC_PERWAIT);
  	} while (--waitcnt);
  
  	return -ETIME;
  }
  
  /*
   * hisi_lpc_target_in - trigger a series of LPC cycles for read operation
   * @lpcdev: pointer to hisi lpc device
   * @para: some parameters used to control the lpc I/O operations
   * @addr: the lpc I/O target port address
   * @buf: where the read back data is stored
   * @opcnt: how many I/O operations required, i.e. data width
   *
   * Returns 0 on success, non-zero on fail.
   */
  static int hisi_lpc_target_in(struct hisi_lpc_dev *lpcdev,
  			      struct lpc_cycle_para *para, unsigned long addr,
  			      unsigned char *buf, unsigned long opcnt)
  {
  	unsigned int cmd_word;
  	unsigned int waitcnt;
  	unsigned long flags;
  	int ret;
  
  	if (!buf || !opcnt || !para || !para->csize || !lpcdev)
  		return -EINVAL;
  
  	cmd_word = 0; /* IO mode, Read */
  	waitcnt = LPC_PEROP_WAITCNT;
  	if (!(para->opflags & FG_INCRADDR_LPC)) {
  		cmd_word |= LPC_REG_CMD_SAMEADDR;
  		waitcnt = LPC_MAX_WAITCNT;
  	}
  
  	/* whole operation must be atomic */
  	spin_lock_irqsave(&lpcdev->cycle_lock, flags);
  
  	writel_relaxed(opcnt, lpcdev->membase + LPC_REG_OP_LEN);
  	writel_relaxed(cmd_word, lpcdev->membase + LPC_REG_CMD);
  	writel_relaxed(addr, lpcdev->membase + LPC_REG_ADDR);
  
  	writel(LPC_REG_STARTUP_SIGNAL_START,
  	       lpcdev->membase + LPC_REG_STARTUP_SIGNAL);
  
  	/* whether the operation is finished */
  	ret = wait_lpc_idle(lpcdev->membase, waitcnt);
  	if (ret) {
  		spin_unlock_irqrestore(&lpcdev->cycle_lock, flags);
  		return ret;
  	}
  
  	readsb(lpcdev->membase + LPC_REG_RDATA, buf, opcnt);
  
  	spin_unlock_irqrestore(&lpcdev->cycle_lock, flags);
  
  	return 0;
  }
  
  /*
   * hisi_lpc_target_out - trigger a series of LPC cycles for write operation
   * @lpcdev: pointer to hisi lpc device
   * @para: some parameters used to control the lpc I/O operations
   * @addr: the lpc I/O target port address
   * @buf: where the data to be written is stored
   * @opcnt: how many I/O operations required, i.e. data width
   *
   * Returns 0 on success, non-zero on fail.
   */
  static int hisi_lpc_target_out(struct hisi_lpc_dev *lpcdev,
  			       struct lpc_cycle_para *para, unsigned long addr,
  			       const unsigned char *buf, unsigned long opcnt)
  {
  	unsigned int waitcnt;
  	unsigned long flags;
  	u32 cmd_word;
  	int ret;
  
  	if (!buf || !opcnt || !para || !lpcdev)
  		return -EINVAL;
  
  	/* default is increasing address */
  	cmd_word = LPC_REG_CMD_OP; /* IO mode, write */
  	waitcnt = LPC_PEROP_WAITCNT;
  	if (!(para->opflags & FG_INCRADDR_LPC)) {
  		cmd_word |= LPC_REG_CMD_SAMEADDR;
  		waitcnt = LPC_MAX_WAITCNT;
  	}
  
  	spin_lock_irqsave(&lpcdev->cycle_lock, flags);
  
  	writel_relaxed(opcnt, lpcdev->membase + LPC_REG_OP_LEN);
  	writel_relaxed(cmd_word, lpcdev->membase + LPC_REG_CMD);
  	writel_relaxed(addr, lpcdev->membase + LPC_REG_ADDR);
  
  	writesb(lpcdev->membase + LPC_REG_WDATA, buf, opcnt);
  
  	writel(LPC_REG_STARTUP_SIGNAL_START,
  	       lpcdev->membase + LPC_REG_STARTUP_SIGNAL);
  
  	/* whether the operation is finished */
  	ret = wait_lpc_idle(lpcdev->membase, waitcnt);
  
  	spin_unlock_irqrestore(&lpcdev->cycle_lock, flags);
  
  	return ret;
  }
  
  static unsigned long hisi_lpc_pio_to_addr(struct hisi_lpc_dev *lpcdev,
  					  unsigned long pio)
  {
  	return pio - lpcdev->io_host->io_start + lpcdev->io_host->hw_start;
  }
  
  /*
   * hisi_lpc_comm_in - input the data in a single operation
   * @hostdata: pointer to the device information relevant to LPC controller
   * @pio: the target I/O port address
   * @dwidth: the data length required to read from the target I/O port
   *
   * When success, data is returned. Otherwise, ~0 is returned.
   */
  static u32 hisi_lpc_comm_in(void *hostdata, unsigned long pio, size_t dwidth)
  {
  	struct hisi_lpc_dev *lpcdev = hostdata;
  	struct lpc_cycle_para iopara;
  	unsigned long addr;
  	u32 rd_data = 0;
  	int ret;
  
  	if (!lpcdev || !dwidth || dwidth > LPC_MAX_DWIDTH)
  		return ~0;
  
  	addr = hisi_lpc_pio_to_addr(lpcdev, pio);
  
  	iopara.opflags = FG_INCRADDR_LPC;
  	iopara.csize = dwidth;
  
  	ret = hisi_lpc_target_in(lpcdev, &iopara, addr,
  				 (unsigned char *)&rd_data, dwidth);
  	if (ret)
  		return ~0;
  
  	return le32_to_cpu(rd_data);
  }
  
  /*
   * hisi_lpc_comm_out - output the data in a single operation
   * @hostdata: pointer to the device information relevant to LPC controller
   * @pio: the target I/O port address
   * @val: a value to be output from caller, maximum is four bytes
   * @dwidth: the data width required writing to the target I/O port
   *
   * This function corresponds to out(b,w,l) only.
   */
  static void hisi_lpc_comm_out(void *hostdata, unsigned long pio,
  			      u32 val, size_t dwidth)
  {
  	struct hisi_lpc_dev *lpcdev = hostdata;
  	struct lpc_cycle_para iopara;
  	const unsigned char *buf;
  	unsigned long addr;
  
  	if (!lpcdev || !dwidth || dwidth > LPC_MAX_DWIDTH)
  		return;
  
  	val = cpu_to_le32(val);
  
  	buf = (const unsigned char *)&val;
  	addr = hisi_lpc_pio_to_addr(lpcdev, pio);
  
  	iopara.opflags = FG_INCRADDR_LPC;
  	iopara.csize = dwidth;
  
  	hisi_lpc_target_out(lpcdev, &iopara, addr, buf, dwidth);
  }
  
  /*
   * hisi_lpc_comm_ins - input the data in the buffer in multiple operations
   * @hostdata: pointer to the device information relevant to LPC controller
   * @pio: the target I/O port address
   * @buffer: a buffer where read/input data bytes are stored
   * @dwidth: the data width required writing to the target I/O port
   * @count: how many data units whose length is dwidth will be read
   *
   * When success, the data read back is stored in buffer pointed by buffer.
   * Returns 0 on success, -errno otherwise.
   */
  static u32 hisi_lpc_comm_ins(void *hostdata, unsigned long pio, void *buffer,
  			     size_t dwidth, unsigned int count)
  {
  	struct hisi_lpc_dev *lpcdev = hostdata;
  	unsigned char *buf = buffer;
  	struct lpc_cycle_para iopara;
  	unsigned long addr;
  
  	if (!lpcdev || !buf || !count || !dwidth || dwidth > LPC_MAX_DWIDTH)
  		return -EINVAL;
  
  	iopara.opflags = 0;
  	if (dwidth > 1)
  		iopara.opflags |= FG_INCRADDR_LPC;
  	iopara.csize = dwidth;
  
  	addr = hisi_lpc_pio_to_addr(lpcdev, pio);
  
  	do {
  		int ret;
  
  		ret = hisi_lpc_target_in(lpcdev, &iopara, addr, buf, dwidth);
  		if (ret)
  			return ret;
  		buf += dwidth;
  	} while (--count);
  
  	return 0;
  }
  
  /*
   * hisi_lpc_comm_outs - output the data in the buffer in multiple operations
   * @hostdata: pointer to the device information relevant to LPC controller
   * @pio: the target I/O port address
   * @buffer: a buffer where write/output data bytes are stored
   * @dwidth: the data width required writing to the target I/O port
   * @count: how many data units whose length is dwidth will be written
   */
  static void hisi_lpc_comm_outs(void *hostdata, unsigned long pio,
  			       const void *buffer, size_t dwidth,
  			       unsigned int count)
  {
  	struct hisi_lpc_dev *lpcdev = hostdata;
  	struct lpc_cycle_para iopara;
  	const unsigned char *buf = buffer;
  	unsigned long addr;
  
  	if (!lpcdev || !buf || !count || !dwidth || dwidth > LPC_MAX_DWIDTH)
  		return;
  
  	iopara.opflags = 0;
  	if (dwidth > 1)
  		iopara.opflags |= FG_INCRADDR_LPC;
  	iopara.csize = dwidth;
  
  	addr = hisi_lpc_pio_to_addr(lpcdev, pio);
  	do {
  		if (hisi_lpc_target_out(lpcdev, &iopara, addr, buf, dwidth))
  			break;
  		buf += dwidth;
  	} while (--count);
  }
  
  static const struct logic_pio_host_ops hisi_lpc_ops = {
  	.in = hisi_lpc_comm_in,
  	.out = hisi_lpc_comm_out,
  	.ins = hisi_lpc_comm_ins,
  	.outs = hisi_lpc_comm_outs,
  };
e0aa1563f   John Garry   HISI LPC: Add ACP...
342
  #ifdef CONFIG_ACPI
e0aa1563f   John Garry   HISI LPC: Add ACP...
343
344
345
346
347
348
349
350
351
352
353
354
355
356
357
358
359
360
  static int hisi_lpc_acpi_xlat_io_res(struct acpi_device *adev,
  				     struct acpi_device *host,
  				     struct resource *res)
  {
  	unsigned long sys_port;
  	resource_size_t len = resource_size(res);
  
  	sys_port = logic_pio_trans_hwaddr(&host->fwnode, res->start, len);
  	if (sys_port == ~0UL)
  		return -EFAULT;
  
  	res->start = sys_port;
  	res->end = sys_port + len;
  
  	return 0;
  }
  
  /*
29c25e694   John Garry   bus: hisi_lpc: Fi...
361
362
363
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
   * Released firmware describes the IO port max address as 0x3fff, which is
   * the max host bus address. Fixup to a proper range. This will probably
   * never be fixed in firmware.
   */
  static void hisi_lpc_acpi_fixup_child_resource(struct device *hostdev,
  					       struct resource *r)
  {
  	if (r->end != 0x3fff)
  		return;
  
  	if (r->start == 0xe4)
  		r->end = 0xe4 + 0x04 - 1;
  	else if (r->start == 0x2f8)
  		r->end = 0x2f8 + 0x08 - 1;
  	else
  		dev_warn(hostdev, "unrecognised resource %pR to fixup, ignoring
  ",
  			 r);
  }
  
  /*
332f632ec   John Garry   HISI LPC: Stop us...
382
   * hisi_lpc_acpi_set_io_res - set the resources for a child
e0aa1563f   John Garry   HISI LPC: Add ACP...
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
431
432
433
434
435
436
437
438
439
440
441
442
443
444
445
   * @child: the device node to be updated the I/O resource
   * @hostdev: the device node associated with host controller
   * @res: double pointer to be set to the address of translated resources
   * @num_res: pointer to variable to hold the number of translated resources
   *
   * Returns 0 when successful, and a negative value for failure.
   *
   * For a given host controller, each child device will have an associated
   * host-relative address resource.  This function will return the translated
   * logical PIO addresses for each child devices resources.
   */
  static int hisi_lpc_acpi_set_io_res(struct device *child,
  				    struct device *hostdev,
  				    const struct resource **res, int *num_res)
  {
  	struct acpi_device *adev;
  	struct acpi_device *host;
  	struct resource_entry *rentry;
  	LIST_HEAD(resource_list);
  	struct resource *resources;
  	int count;
  	int i;
  
  	if (!child || !hostdev)
  		return -EINVAL;
  
  	host = to_acpi_device(hostdev);
  	adev = to_acpi_device(child);
  
  	if (!adev->status.present) {
  		dev_dbg(child, "device is not present
  ");
  		return -EIO;
  	}
  
  	if (acpi_device_enumerated(adev)) {
  		dev_dbg(child, "has been enumerated
  ");
  		return -EIO;
  	}
  
  	/*
  	 * The following code segment to retrieve the resources is common to
  	 * acpi_create_platform_device(), so consider a common helper function
  	 * in future.
  	 */
  	count = acpi_dev_get_resources(adev, &resource_list, NULL, NULL);
  	if (count <= 0) {
  		dev_dbg(child, "failed to get resources
  ");
  		return count ? count : -EIO;
  	}
  
  	resources = devm_kcalloc(hostdev, count, sizeof(*resources),
  				 GFP_KERNEL);
  	if (!resources) {
  		dev_warn(hostdev, "could not allocate memory for %d resources
  ",
  			 count);
  		acpi_dev_free_resource_list(&resource_list);
  		return -ENOMEM;
  	}
  	count = 0;
29c25e694   John Garry   bus: hisi_lpc: Fi...
446
447
448
449
450
  	list_for_each_entry(rentry, &resource_list, node) {
  		resources[count] = *rentry->res;
  		hisi_lpc_acpi_fixup_child_resource(hostdev, &resources[count]);
  		count++;
  	}
e0aa1563f   John Garry   HISI LPC: Add ACP...
451
452
453
454
455
456
457
458
459
460
461
462
463
464
465
466
467
468
469
470
471
472
  
  	acpi_dev_free_resource_list(&resource_list);
  
  	/* translate the I/O resources */
  	for (i = 0; i < count; i++) {
  		int ret;
  
  		if (!(resources[i].flags & IORESOURCE_IO))
  			continue;
  		ret = hisi_lpc_acpi_xlat_io_res(adev, host, &resources[i]);
  		if (ret) {
  			dev_err(child, "translate IO range %pR failed (%d)
  ",
  				&resources[i], ret);
  			return ret;
  		}
  	}
  	*res = resources;
  	*num_res = count;
  
  	return 0;
  }
99c0228d6   John Garry   HISI LPC: Re-Add ...
473
474
475
476
477
478
479
480
481
482
483
484
  static int hisi_lpc_acpi_remove_subdev(struct device *dev, void *unused)
  {
  	platform_device_unregister(to_platform_device(dev));
  	return 0;
  }
  
  struct hisi_lpc_acpi_cell {
  	const char *hid;
  	const char *name;
  	void *pdata;
  	size_t pdata_size;
  };
10e62b479   John Garry   bus: hisi_lpc: Ad...
485
486
487
488
489
490
491
492
493
494
  static void hisi_lpc_acpi_remove(struct device *hostdev)
  {
  	struct acpi_device *adev = ACPI_COMPANION(hostdev);
  	struct acpi_device *child;
  
  	device_for_each_child(hostdev, NULL, hisi_lpc_acpi_remove_subdev);
  
  	list_for_each_entry(child, &adev->children, node)
  		acpi_device_clear_enumerated(child);
  }
e0aa1563f   John Garry   HISI LPC: Add ACP...
495
496
497
498
499
500
  /*
   * hisi_lpc_acpi_probe - probe children for ACPI FW
   * @hostdev: LPC host device pointer
   *
   * Returns 0 when successful, and a negative value for failure.
   *
99c0228d6   John Garry   HISI LPC: Re-Add ...
501
502
503
   * Create a platform device per child, fixing up the resources
   * from bus addresses to Logical PIO addresses.
   *
e0aa1563f   John Garry   HISI LPC: Add ACP...
504
505
506
507
   */
  static int hisi_lpc_acpi_probe(struct device *hostdev)
  {
  	struct acpi_device *adev = ACPI_COMPANION(hostdev);
e0aa1563f   John Garry   HISI LPC: Add ACP...
508
  	struct acpi_device *child;
332f632ec   John Garry   HISI LPC: Stop us...
509
  	int ret;
e0aa1563f   John Garry   HISI LPC: Add ACP...
510

e0aa1563f   John Garry   HISI LPC: Add ACP...
511
512
  	/* Only consider the children of the host */
  	list_for_each_entry(child, &adev->children, node) {
99c0228d6   John Garry   HISI LPC: Re-Add ...
513
514
515
  		const char *hid = acpi_device_hid(child);
  		const struct hisi_lpc_acpi_cell *cell;
  		struct platform_device *pdev;
332f632ec   John Garry   HISI LPC: Stop us...
516
  		const struct resource *res;
99c0228d6   John Garry   HISI LPC: Re-Add ...
517
  		bool found = false;
332f632ec   John Garry   HISI LPC: Stop us...
518
519
520
521
  		int num_res;
  
  		ret = hisi_lpc_acpi_set_io_res(&child->dev, &adev->dev, &res,
  					       &num_res);
e0aa1563f   John Garry   HISI LPC: Add ACP...
522
  		if (ret) {
332f632ec   John Garry   HISI LPC: Stop us...
523
524
  			dev_warn(hostdev, "set resource fail (%d)
  ", ret);
99c0228d6   John Garry   HISI LPC: Re-Add ...
525
526
527
528
529
530
531
532
533
  			goto fail;
  		}
  
  		cell = (struct hisi_lpc_acpi_cell []){
  			/* ipmi */
  			{
  				.hid = "IPI0001",
  				.name = "hisi-lpc-ipmi",
  			},
adf3457b4   John Garry   HISI LPC: Add ACP...
534
535
536
537
538
539
540
541
542
543
544
545
546
547
548
549
  			/* 8250-compatible uart */
  			{
  				.hid = "HISI1031",
  				.name = "serial8250",
  				.pdata = (struct plat_serial8250_port []) {
  					{
  						.iobase = res->start,
  						.uartclk = 1843200,
  						.iotype = UPIO_PORT,
  						.flags = UPF_BOOT_AUTOCONF,
  					},
  					{}
  				},
  				.pdata_size = 2 *
  					sizeof(struct plat_serial8250_port),
  			},
99c0228d6   John Garry   HISI LPC: Re-Add ...
550
551
552
553
554
555
556
557
  			{}
  		};
  
  		for (; cell && cell->name; cell++) {
  			if (!strcmp(cell->hid, hid)) {
  				found = true;
  				break;
  			}
e0aa1563f   John Garry   HISI LPC: Add ACP...
558
  		}
99c0228d6   John Garry   HISI LPC: Re-Add ...
559
560
561
  
  		if (!found) {
  			dev_warn(hostdev,
705c0ee8d   John Garry   bus: hisi_lpc: Do...
562
563
  				 "could not find cell for child device (%s), discarding
  ",
99c0228d6   John Garry   HISI LPC: Re-Add ...
564
  				 hid);
705c0ee8d   John Garry   bus: hisi_lpc: Do...
565
  			continue;
99c0228d6   John Garry   HISI LPC: Re-Add ...
566
567
568
569
570
571
572
573
574
575
576
577
578
579
580
581
582
583
584
585
586
587
588
589
590
  		}
  
  		pdev = platform_device_alloc(cell->name, PLATFORM_DEVID_AUTO);
  		if (!pdev) {
  			ret = -ENOMEM;
  			goto fail;
  		}
  
  		pdev->dev.parent = hostdev;
  		ACPI_COMPANION_SET(&pdev->dev, child);
  
  		ret = platform_device_add_resources(pdev, res, num_res);
  		if (ret)
  			goto fail;
  
  		ret = platform_device_add_data(pdev, cell->pdata,
  					       cell->pdata_size);
  		if (ret)
  			goto fail;
  
  		ret = platform_device_add(pdev);
  		if (ret)
  			goto fail;
  
  		acpi_device_set_enumerated(child);
e0aa1563f   John Garry   HISI LPC: Add ACP...
591
592
593
  	}
  
  	return 0;
99c0228d6   John Garry   HISI LPC: Re-Add ...
594
595
  
  fail:
10e62b479   John Garry   bus: hisi_lpc: Ad...
596
  	hisi_lpc_acpi_remove(hostdev);
99c0228d6   John Garry   HISI LPC: Re-Add ...
597
  	return ret;
e0aa1563f   John Garry   HISI LPC: Add ACP...
598
599
600
601
602
603
604
605
606
607
608
  }
  
  static const struct acpi_device_id hisi_lpc_acpi_match[] = {
  	{"HISI0191"},
  	{}
  };
  #else
  static int hisi_lpc_acpi_probe(struct device *dev)
  {
  	return -ENODEV;
  }
10e62b479   John Garry   bus: hisi_lpc: Ad...
609
610
611
612
  
  static void hisi_lpc_acpi_remove(struct device *hostdev)
  {
  }
e0aa1563f   John Garry   HISI LPC: Add ACP...
613
  #endif // CONFIG_ACPI
adf38bb0b   Zhichang Yuan   HISI LPC: Support...
614
615
616
617
618
619
620
621
622
623
624
625
626
627
628
629
630
631
632
633
634
635
636
637
638
639
640
641
642
643
644
645
646
647
648
  /*
   * hisi_lpc_probe - the probe callback function for hisi lpc host,
   *		   will finish all the initialization.
   * @pdev: the platform device corresponding to hisi lpc host
   *
   * Returns 0 on success, non-zero on fail.
   */
  static int hisi_lpc_probe(struct platform_device *pdev)
  {
  	struct device *dev = &pdev->dev;
  	struct acpi_device *acpi_device = ACPI_COMPANION(dev);
  	struct logic_pio_hwaddr *range;
  	struct hisi_lpc_dev *lpcdev;
  	resource_size_t io_end;
  	struct resource *res;
  	int ret;
  
  	lpcdev = devm_kzalloc(dev, sizeof(*lpcdev), GFP_KERNEL);
  	if (!lpcdev)
  		return -ENOMEM;
  
  	spin_lock_init(&lpcdev->cycle_lock);
  
  	res = platform_get_resource(pdev, IORESOURCE_MEM, 0);
  	lpcdev->membase = devm_ioremap_resource(dev, res);
  	if (IS_ERR(lpcdev->membase))
  		return PTR_ERR(lpcdev->membase);
  
  	range = devm_kzalloc(dev, sizeof(*range), GFP_KERNEL);
  	if (!range)
  		return -ENOMEM;
  
  	range->fwnode = dev->fwnode;
  	range->flags = LOGIC_PIO_INDIRECT;
  	range->size = PIO_INDIRECT_SIZE;
1b15a5632   John Garry   bus: hisi_lpc: Un...
649
650
651
  	range->hostdata = lpcdev;
  	range->ops = &hisi_lpc_ops;
  	lpcdev->io_host = range;
adf38bb0b   Zhichang Yuan   HISI LPC: Support...
652
653
654
655
656
657
658
  
  	ret = logic_pio_register_range(range);
  	if (ret) {
  		dev_err(dev, "register IO range failed (%d)!
  ", ret);
  		return ret;
  	}
adf38bb0b   Zhichang Yuan   HISI LPC: Support...
659
660
  
  	/* register the LPC host PIO resources */
e0aa1563f   John Garry   HISI LPC: Add ACP...
661
662
663
  	if (acpi_device)
  		ret = hisi_lpc_acpi_probe(dev);
  	else
adf38bb0b   Zhichang Yuan   HISI LPC: Support...
664
  		ret = of_platform_populate(dev->of_node, NULL, NULL, dev);
1b15a5632   John Garry   bus: hisi_lpc: Un...
665
666
  	if (ret) {
  		logic_pio_unregister_range(range);
e0aa1563f   John Garry   HISI LPC: Add ACP...
667
  		return ret;
1b15a5632   John Garry   bus: hisi_lpc: Un...
668
  	}
adf38bb0b   Zhichang Yuan   HISI LPC: Support...
669

10e62b479   John Garry   bus: hisi_lpc: Ad...
670
  	dev_set_drvdata(dev, lpcdev);
adf38bb0b   Zhichang Yuan   HISI LPC: Support...
671
672
673
674
675
676
677
  	io_end = lpcdev->io_host->io_start + lpcdev->io_host->size;
  	dev_info(dev, "registered range [%pa - %pa]
  ",
  		 &lpcdev->io_host->io_start, &io_end);
  
  	return ret;
  }
10e62b479   John Garry   bus: hisi_lpc: Ad...
678
679
680
681
682
683
684
685
686
687
688
689
690
691
692
693
  static int hisi_lpc_remove(struct platform_device *pdev)
  {
  	struct device *dev = &pdev->dev;
  	struct acpi_device *acpi_device = ACPI_COMPANION(dev);
  	struct hisi_lpc_dev *lpcdev = dev_get_drvdata(dev);
  	struct logic_pio_hwaddr *range = lpcdev->io_host;
  
  	if (acpi_device)
  		hisi_lpc_acpi_remove(dev);
  	else
  		of_platform_depopulate(dev);
  
  	logic_pio_unregister_range(range);
  
  	return 0;
  }
adf38bb0b   Zhichang Yuan   HISI LPC: Support...
694
695
696
697
698
699
700
701
702
703
  static const struct of_device_id hisi_lpc_of_match[] = {
  	{ .compatible = "hisilicon,hip06-lpc", },
  	{ .compatible = "hisilicon,hip07-lpc", },
  	{}
  };
  
  static struct platform_driver hisi_lpc_driver = {
  	.driver = {
  		.name           = DRV_NAME,
  		.of_match_table = hisi_lpc_of_match,
e0aa1563f   John Garry   HISI LPC: Add ACP...
704
  		.acpi_match_table = ACPI_PTR(hisi_lpc_acpi_match),
adf38bb0b   Zhichang Yuan   HISI LPC: Support...
705
706
  	},
  	.probe = hisi_lpc_probe,
10e62b479   John Garry   bus: hisi_lpc: Ad...
707
  	.remove = hisi_lpc_remove,
adf38bb0b   Zhichang Yuan   HISI LPC: Support...
708
709
  };
  builtin_platform_driver(hisi_lpc_driver);