Blame view

drivers/ata/libahci_platform.c 19.5 KB
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
  /*
   * AHCI SATA platform library
   *
   * Copyright 2004-2005  Red Hat, Inc.
   *   Jeff Garzik <jgarzik@pobox.com>
   * Copyright 2010  MontaVista Software, LLC.
   *   Anton Vorontsov <avorontsov@ru.mvista.com>
   *
   * This program is free software; you can redistribute it and/or modify
   * it under the terms of the GNU General Public License as published by
   * the Free Software Foundation; either version 2, or (at your option)
   * any later version.
   */
  
  #include <linux/clk.h>
  #include <linux/kernel.h>
  #include <linux/gfp.h>
  #include <linux/module.h>
  #include <linux/pm.h>
  #include <linux/interrupt.h>
  #include <linux/device.h>
  #include <linux/platform_device.h>
  #include <linux/libata.h>
  #include <linux/ahci_platform.h>
  #include <linux/phy/phy.h>
  #include <linux/pm_runtime.h>
c7d7ddee7   Gregory CLEMENT   ata: libahci: All...
27
  #include <linux/of_platform.h>
9d2ab9957   Kunihiko Hayashi   ata: libahci_plat...
28
  #include <linux/reset.h>
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
29
30
31
32
33
34
35
36
37
  #include "ahci.h"
  
  static void ahci_host_stop(struct ata_host *host);
  
  struct ata_port_operations ahci_platform_ops = {
  	.inherits	= &ahci_ops,
  	.host_stop	= ahci_host_stop,
  };
  EXPORT_SYMBOL_GPL(ahci_platform_ops);
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
38
  /**
b1a9edbda   Antoine Ténart   ata: libahci: all...
39
40
41
42
43
44
45
46
47
48
   * ahci_platform_enable_phys - Enable PHYs
   * @hpriv: host private area to store config values
   *
   * This function enables all the PHYs found in hpriv->phys, if any.
   * If a PHY fails to be enabled, it disables all the PHYs already
   * enabled in reverse order and returns an error.
   *
   * RETURNS:
   * 0 on success otherwise a negative error code
   */
6bb86fefa   Fabio Estevam   libahci_platform:...
49
  static int ahci_platform_enable_phys(struct ahci_host_priv *hpriv)
b1a9edbda   Antoine Ténart   ata: libahci: all...
50
51
52
53
  {
  	int rc, i;
  
  	for (i = 0; i < hpriv->nports; i++) {
b1a9edbda   Antoine Ténart   ata: libahci: all...
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
  		rc = phy_init(hpriv->phys[i]);
  		if (rc)
  			goto disable_phys;
  
  		rc = phy_power_on(hpriv->phys[i]);
  		if (rc) {
  			phy_exit(hpriv->phys[i]);
  			goto disable_phys;
  		}
  	}
  
  	return 0;
  
  disable_phys:
  	while (--i >= 0) {
  		phy_power_off(hpriv->phys[i]);
  		phy_exit(hpriv->phys[i]);
  	}
  	return rc;
  }
b1a9edbda   Antoine Ténart   ata: libahci: all...
74
75
76
77
78
79
80
  
  /**
   * ahci_platform_disable_phys - Disable PHYs
   * @hpriv: host private area to store config values
   *
   * This function disables all PHYs found in hpriv->phys.
   */
6bb86fefa   Fabio Estevam   libahci_platform:...
81
  static void ahci_platform_disable_phys(struct ahci_host_priv *hpriv)
b1a9edbda   Antoine Ténart   ata: libahci: all...
82
83
84
85
  {
  	int i;
  
  	for (i = 0; i < hpriv->nports; i++) {
b1a9edbda   Antoine Ténart   ata: libahci: all...
86
87
88
89
  		phy_power_off(hpriv->phys[i]);
  		phy_exit(hpriv->phys[i]);
  	}
  }
b1a9edbda   Antoine Ténart   ata: libahci: all...
90
91
  
  /**
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
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
   * ahci_platform_enable_clks - Enable platform clocks
   * @hpriv: host private area to store config values
   *
   * This function enables all the clks found in hpriv->clks, starting at
   * index 0. If any clk fails to enable it disables all the clks already
   * enabled in reverse order, and then returns an error.
   *
   * RETURNS:
   * 0 on success otherwise a negative error code
   */
  int ahci_platform_enable_clks(struct ahci_host_priv *hpriv)
  {
  	int c, rc;
  
  	for (c = 0; c < AHCI_MAX_CLKS && hpriv->clks[c]; c++) {
  		rc = clk_prepare_enable(hpriv->clks[c]);
  		if (rc)
  			goto disable_unprepare_clk;
  	}
  	return 0;
  
  disable_unprepare_clk:
  	while (--c >= 0)
  		clk_disable_unprepare(hpriv->clks[c]);
  	return rc;
  }
  EXPORT_SYMBOL_GPL(ahci_platform_enable_clks);
  
  /**
   * ahci_platform_disable_clks - Disable platform clocks
   * @hpriv: host private area to store config values
   *
   * This function disables all the clks found in hpriv->clks, in reverse
   * order of ahci_platform_enable_clks (starting at the end of the array).
   */
  void ahci_platform_disable_clks(struct ahci_host_priv *hpriv)
  {
  	int c;
  
  	for (c = AHCI_MAX_CLKS - 1; c >= 0; c--)
  		if (hpriv->clks[c])
  			clk_disable_unprepare(hpriv->clks[c]);
  }
  EXPORT_SYMBOL_GPL(ahci_platform_disable_clks);
  
  /**
c7d7ddee7   Gregory CLEMENT   ata: libahci: All...
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
   * ahci_platform_enable_regulators - Enable regulators
   * @hpriv: host private area to store config values
   *
   * This function enables all the regulators found in
   * hpriv->target_pwrs, if any.  If a regulator fails to be enabled, it
   * disables all the regulators already enabled in reverse order and
   * returns an error.
   *
   * RETURNS:
   * 0 on success otherwise a negative error code
   */
  int ahci_platform_enable_regulators(struct ahci_host_priv *hpriv)
  {
  	int rc, i;
  
  	for (i = 0; i < hpriv->nports; i++) {
  		if (!hpriv->target_pwrs[i])
  			continue;
  
  		rc = regulator_enable(hpriv->target_pwrs[i]);
  		if (rc)
  			goto disable_target_pwrs;
  	}
  
  	return 0;
  
  disable_target_pwrs:
  	while (--i >= 0)
  		if (hpriv->target_pwrs[i])
  			regulator_disable(hpriv->target_pwrs[i]);
  
  	return rc;
  }
  EXPORT_SYMBOL_GPL(ahci_platform_enable_regulators);
  
  /**
   * ahci_platform_disable_regulators - Disable regulators
   * @hpriv: host private area to store config values
   *
   * This function disables all regulators found in hpriv->target_pwrs.
   */
  void ahci_platform_disable_regulators(struct ahci_host_priv *hpriv)
  {
  	int i;
  
  	for (i = 0; i < hpriv->nports; i++) {
  		if (!hpriv->target_pwrs[i])
  			continue;
  		regulator_disable(hpriv->target_pwrs[i]);
  	}
  }
  EXPORT_SYMBOL_GPL(ahci_platform_disable_regulators);
  /**
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
191
192
193
194
195
196
197
   * ahci_platform_enable_resources - Enable platform resources
   * @hpriv: host private area to store config values
   *
   * This function enables all ahci_platform managed resources in the
   * following order:
   * 1) Regulator
   * 2) Clocks (through ahci_platform_enable_clks)
9d2ab9957   Kunihiko Hayashi   ata: libahci_plat...
198
199
   * 3) Resets
   * 4) Phys
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
200
201
202
203
204
205
206
207
208
209
   *
   * If resource enabling fails at any point the previous enabled resources
   * are disabled in reverse order.
   *
   * RETURNS:
   * 0 on success otherwise a negative error code
   */
  int ahci_platform_enable_resources(struct ahci_host_priv *hpriv)
  {
  	int rc;
c7d7ddee7   Gregory CLEMENT   ata: libahci: All...
210
211
212
  	rc = ahci_platform_enable_regulators(hpriv);
  	if (rc)
  		return rc;
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
213
214
215
216
  
  	rc = ahci_platform_enable_clks(hpriv);
  	if (rc)
  		goto disable_regulator;
9d2ab9957   Kunihiko Hayashi   ata: libahci_plat...
217
  	rc = reset_control_deassert(hpriv->rsts);
f0f56716f   Kunihiko Hayashi   ata: ahci-platfor...
218
  	if (rc)
fd17ed684   Kunihiko Hayashi   Revert "ata: ahci...
219
  		goto disable_clks;
f0f56716f   Kunihiko Hayashi   ata: ahci-platfor...
220

9d2ab9957   Kunihiko Hayashi   ata: libahci_plat...
221
222
223
  	rc = ahci_platform_enable_phys(hpriv);
  	if (rc)
  		goto disable_resets;
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
224
  	return 0;
9d2ab9957   Kunihiko Hayashi   ata: libahci_plat...
225
226
  disable_resets:
  	reset_control_assert(hpriv->rsts);
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
227
228
229
230
  disable_clks:
  	ahci_platform_disable_clks(hpriv);
  
  disable_regulator:
c7d7ddee7   Gregory CLEMENT   ata: libahci: All...
231
  	ahci_platform_disable_regulators(hpriv);
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
232
233
234
235
236
237
238
239
240
241
  	return rc;
  }
  EXPORT_SYMBOL_GPL(ahci_platform_enable_resources);
  
  /**
   * ahci_platform_disable_resources - Disable platform resources
   * @hpriv: host private area to store config values
   *
   * This function disables all ahci_platform managed resources in the
   * following order:
b1a9edbda   Antoine Ténart   ata: libahci: all...
242
   * 1) Phys
9d2ab9957   Kunihiko Hayashi   ata: libahci_plat...
243
244
245
   * 2) Resets
   * 3) Clocks (through ahci_platform_disable_clks)
   * 4) Regulator
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
246
247
248
   */
  void ahci_platform_disable_resources(struct ahci_host_priv *hpriv)
  {
b1a9edbda   Antoine Ténart   ata: libahci: all...
249
  	ahci_platform_disable_phys(hpriv);
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
250

9d2ab9957   Kunihiko Hayashi   ata: libahci_plat...
251
  	reset_control_assert(hpriv->rsts);
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
252
  	ahci_platform_disable_clks(hpriv);
c7d7ddee7   Gregory CLEMENT   ata: libahci: All...
253
  	ahci_platform_disable_regulators(hpriv);
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
254
255
256
257
258
259
260
261
262
  }
  EXPORT_SYMBOL_GPL(ahci_platform_disable_resources);
  
  static void ahci_platform_put_resources(struct device *dev, void *res)
  {
  	struct ahci_host_priv *hpriv = res;
  	int c;
  
  	if (hpriv->got_runtime_pm) {
eac7e072d   Tejun Heo   Revert "ata: ahci...
263
  		pm_runtime_put_sync(dev);
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
264
265
266
267
268
  		pm_runtime_disable(dev);
  	}
  
  	for (c = 0; c < AHCI_MAX_CLKS && hpriv->clks[c]; c++)
  		clk_put(hpriv->clks[c]);
c7d7ddee7   Gregory CLEMENT   ata: libahci: All...
269
270
271
272
273
274
275
276
  	/*
  	 * The regulators are tied to child node device and not to the
  	 * SATA device itself. So we can't use devm for automatically
  	 * releasing them. We have to do it manually here.
  	 */
  	for (c = 0; c < hpriv->nports; c++)
  		if (hpriv->target_pwrs && hpriv->target_pwrs[c])
  			regulator_put(hpriv->target_pwrs[c]);
04ba94881   Corentin Labbe   Revert "ata: ahci...
277
278
  
  	kfree(hpriv->target_pwrs);
c7d7ddee7   Gregory CLEMENT   ata: libahci: All...
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
  }
  
  static int ahci_platform_get_phy(struct ahci_host_priv *hpriv, u32 port,
  				struct device *dev, struct device_node *node)
  {
  	int rc;
  
  	hpriv->phys[port] = devm_of_phy_get(dev, node, NULL);
  
  	if (!IS_ERR(hpriv->phys[port]))
  		return 0;
  
  	rc = PTR_ERR(hpriv->phys[port]);
  	switch (rc) {
  	case -ENOSYS:
  		/* No PHY support. Check if PHY is required. */
  		if (of_find_property(node, "phys", NULL)) {
  			dev_err(dev,
  				"couldn't get PHY in node %s: ENOSYS
  ",
  				node->name);
  			break;
  		}
05b836059   Gustavo A. R. Silva   ata: mark expecte...
302
  		/* fall through */
c7d7ddee7   Gregory CLEMENT   ata: libahci: All...
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
  	case -ENODEV:
  		/* continue normally */
  		hpriv->phys[port] = NULL;
  		rc = 0;
  		break;
  
  	default:
  		dev_err(dev,
  			"couldn't get PHY in node %s: %d
  ",
  			node->name, rc);
  
  		break;
  	}
  
  	return rc;
  }
  
  static int ahci_platform_get_regulator(struct ahci_host_priv *hpriv, u32 port,
  				struct device *dev)
  {
  	struct regulator *target_pwr;
  	int rc = 0;
  
  	target_pwr = regulator_get_optional(dev, "target");
  
  	if (!IS_ERR(target_pwr))
  		hpriv->target_pwrs[port] = target_pwr;
  	else
  		rc = PTR_ERR(target_pwr);
  
  	return rc;
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
335
336
337
338
339
  }
  
  /**
   * ahci_platform_get_resources - Get platform resources
   * @pdev: platform device to get resources for
16af2d658   Kunihiko Hayashi   ata: add an extra...
340
   * @flags: bitmap representing the resource to get
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
341
342
343
344
345
346
347
348
   *
   * This function allocates an ahci_host_priv struct, and gets the following
   * resources, storing a reference to them inside the returned struct:
   *
   * 1) mmio registers (IORESOURCE_MEM 0, mandatory)
   * 2) regulator for controlling the targets power (optional)
   * 3) 0 - AHCI_MAX_CLKS clocks, as specified in the devs devicetree node,
   *    or for non devicetree enabled platforms a single clock
9d2ab9957   Kunihiko Hayashi   ata: libahci_plat...
349
350
   * 4) resets, if flags has AHCI_PLATFORM_GET_RESETS (optional)
   * 5) phys (optional)
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
351
352
353
354
   *
   * RETURNS:
   * The allocated ahci_host_priv on success, otherwise an ERR_PTR value
   */
16af2d658   Kunihiko Hayashi   ata: add an extra...
355
356
  struct ahci_host_priv *ahci_platform_get_resources(struct platform_device *pdev,
  						   unsigned int flags)
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
357
358
359
360
  {
  	struct device *dev = &pdev->dev;
  	struct ahci_host_priv *hpriv;
  	struct clk *clk;
b1a9edbda   Antoine Ténart   ata: libahci: all...
361
  	struct device_node *child;
a4b9f5ed0   Corentin Labbe   ata: ahci_platfor...
362
  	int i, enabled_ports = 0, rc = -ENOMEM, child_nodes;
b1a9edbda   Antoine Ténart   ata: libahci: all...
363
  	u32 mask_port_map = 0;
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
364
365
366
367
368
369
370
371
372
373
374
375
376
377
378
379
380
381
382
  
  	if (!devres_open_group(dev, NULL, GFP_KERNEL))
  		return ERR_PTR(-ENOMEM);
  
  	hpriv = devres_alloc(ahci_platform_put_resources, sizeof(*hpriv),
  			     GFP_KERNEL);
  	if (!hpriv)
  		goto err_out;
  
  	devres_add(dev, hpriv);
  
  	hpriv->mmio = devm_ioremap_resource(dev,
  			      platform_get_resource(pdev, IORESOURCE_MEM, 0));
  	if (IS_ERR(hpriv->mmio)) {
  		dev_err(dev, "no mmio space
  ");
  		rc = PTR_ERR(hpriv->mmio);
  		goto err_out;
  	}
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
383
384
385
386
387
388
389
390
391
392
393
394
395
396
397
398
399
400
401
402
  	for (i = 0; i < AHCI_MAX_CLKS; i++) {
  		/*
  		 * For now we must use clk_get(dev, NULL) for the first clock,
  		 * because some platforms (da850, spear13xx) are not yet
  		 * converted to use devicetree for clocks.  For new platforms
  		 * this is equivalent to of_clk_get(dev->of_node, 0).
  		 */
  		if (i == 0)
  			clk = clk_get(dev, NULL);
  		else
  			clk = of_clk_get(dev->of_node, i);
  
  		if (IS_ERR(clk)) {
  			rc = PTR_ERR(clk);
  			if (rc == -EPROBE_DEFER)
  				goto err_out;
  			break;
  		}
  		hpriv->clks[i] = clk;
  	}
9d2ab9957   Kunihiko Hayashi   ata: libahci_plat...
403
404
405
406
407
408
409
  	if (flags & AHCI_PLATFORM_GET_RESETS) {
  		hpriv->rsts = devm_reset_control_array_get_optional_shared(dev);
  		if (IS_ERR(hpriv->rsts)) {
  			rc = PTR_ERR(hpriv->rsts);
  			goto err_out;
  		}
  	}
c7d7ddee7   Gregory CLEMENT   ata: libahci: All...
410
  	hpriv->nports = child_nodes = of_get_child_count(dev->of_node);
b1a9edbda   Antoine Ténart   ata: libahci: all...
411

c7d7ddee7   Gregory CLEMENT   ata: libahci: All...
412
413
414
415
416
417
418
  	/*
  	 * If no sub-node was found, we still need to set nports to
  	 * one in order to be able to use the
  	 * ahci_platform_[en|dis]able_[phys|regulators] functions.
  	 */
  	if (!child_nodes)
  		hpriv->nports = 1;
a4b9f5ed0   Corentin Labbe   ata: ahci_platfor...
419
  	hpriv->phys = devm_kcalloc(dev, hpriv->nports, sizeof(*hpriv->phys), GFP_KERNEL);
c7d7ddee7   Gregory CLEMENT   ata: libahci: All...
420
421
422
423
  	if (!hpriv->phys) {
  		rc = -ENOMEM;
  		goto err_out;
  	}
04ba94881   Corentin Labbe   Revert "ata: ahci...
424
425
426
427
428
  	/*
  	 * We cannot use devm_ here, since ahci_platform_put_resources() uses
  	 * target_pwrs after devm_ have freed memory
  	 */
  	hpriv->target_pwrs = kcalloc(hpriv->nports, sizeof(*hpriv->target_pwrs), GFP_KERNEL);
c7d7ddee7   Gregory CLEMENT   ata: libahci: All...
429
430
431
432
  	if (!hpriv->target_pwrs) {
  		rc = -ENOMEM;
  		goto err_out;
  	}
b1a9edbda   Antoine Ténart   ata: libahci: all...
433

c7d7ddee7   Gregory CLEMENT   ata: libahci: All...
434
  	if (child_nodes) {
b1a9edbda   Antoine Ténart   ata: libahci: all...
435
436
  		for_each_child_of_node(dev->of_node, child) {
  			u32 port;
f627cfdeb   Guenter Roeck   ata: libahci: Use...
437
  			struct platform_device *port_dev __maybe_unused;
b1a9edbda   Antoine Ténart   ata: libahci: all...
438
439
440
441
442
443
  
  			if (!of_device_is_available(child))
  				continue;
  
  			if (of_property_read_u32(child, "reg", &port)) {
  				rc = -EINVAL;
acbd57335   Mikko Perttunen   libahci_platform:...
444
445
  				goto err_out;
  			}
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
446

b1a9edbda   Antoine Ténart   ata: libahci: all...
447
448
449
450
451
  			if (port >= hpriv->nports) {
  				dev_warn(dev, "invalid port number %d
  ", port);
  				continue;
  			}
b1a9edbda   Antoine Ténart   ata: libahci: all...
452
  			mask_port_map |= BIT(port);
f627cfdeb   Guenter Roeck   ata: libahci: Use...
453
  #ifdef CONFIG_OF_ADDRESS
c7d7ddee7   Gregory CLEMENT   ata: libahci: All...
454
455
456
457
458
459
460
461
462
  			of_platform_device_create(child, NULL, NULL);
  
  			port_dev = of_find_device_by_node(child);
  
  			if (port_dev) {
  				rc = ahci_platform_get_regulator(hpriv, port,
  								&port_dev->dev);
  				if (rc == -EPROBE_DEFER)
  					goto err_out;
b1a9edbda   Antoine Ténart   ata: libahci: all...
463
  			}
f627cfdeb   Guenter Roeck   ata: libahci: Use...
464
  #endif
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
465

c7d7ddee7   Gregory CLEMENT   ata: libahci: All...
466
467
468
  			rc = ahci_platform_get_phy(hpriv, port, dev, child);
  			if (rc)
  				goto err_out;
b1a9edbda   Antoine Ténart   ata: libahci: all...
469
470
471
472
473
474
  			enabled_ports++;
  		}
  		if (!enabled_ports) {
  			dev_warn(dev, "No port enabled
  ");
  			rc = -ENODEV;
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
475
476
  			goto err_out;
  		}
b1a9edbda   Antoine Ténart   ata: libahci: all...
477
478
479
480
481
482
483
484
  
  		if (!hpriv->mask_port_map)
  			hpriv->mask_port_map = mask_port_map;
  	} else {
  		/*
  		 * If no sub-node was found, keep this for device tree
  		 * compatibility
  		 */
c7d7ddee7   Gregory CLEMENT   ata: libahci: All...
485
486
487
  		rc = ahci_platform_get_phy(hpriv, 0, dev, dev->of_node);
  		if (rc)
  			goto err_out;
b1a9edbda   Antoine Ténart   ata: libahci: all...
488

c7d7ddee7   Gregory CLEMENT   ata: libahci: All...
489
490
491
  		rc = ahci_platform_get_regulator(hpriv, 0, dev);
  		if (rc == -EPROBE_DEFER)
  			goto err_out;
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
492
  	}
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
493
  	pm_runtime_enable(dev);
eac7e072d   Tejun Heo   Revert "ata: ahci...
494
  	pm_runtime_get_sync(dev);
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
495
496
497
498
499
500
501
502
503
504
505
506
507
508
509
510
  	hpriv->got_runtime_pm = true;
  
  	devres_remove_group(dev, NULL);
  	return hpriv;
  
  err_out:
  	devres_release_group(dev, NULL);
  	return ERR_PTR(rc);
  }
  EXPORT_SYMBOL_GPL(ahci_platform_get_resources);
  
  /**
   * ahci_platform_init_host - Bring up an ahci-platform host
   * @pdev: platform device pointer for the host
   * @hpriv: ahci-host private data for the host
   * @pi_template: template for the ata_port_info to use
018d5ef20   Akinobu Mita   ata: ahci_platfor...
511
   * @sht: scsi_host_template to use when registering
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
512
513
   *
   * This function does all the usual steps needed to bring up an
b1a9edbda   Antoine Ténart   ata: libahci: all...
514
   * ahci-platform host, note any necessary resources (ie clks, phys, etc.)
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
515
516
517
518
519
520
521
   * must be initialized / enabled before calling this.
   *
   * RETURNS:
   * 0 on success otherwise a negative error code
   */
  int ahci_platform_init_host(struct platform_device *pdev,
  			    struct ahci_host_priv *hpriv,
018d5ef20   Akinobu Mita   ata: ahci_platfor...
522
523
  			    const struct ata_port_info *pi_template,
  			    struct scsi_host_template *sht)
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
524
525
526
527
528
529
530
531
532
  {
  	struct device *dev = &pdev->dev;
  	struct ata_port_info pi = *pi_template;
  	const struct ata_port_info *ppi[] = { &pi, NULL };
  	struct ata_host *host;
  	int i, irq, n_ports, rc;
  
  	irq = platform_get_irq(pdev, 0);
  	if (irq <= 0) {
c034640a3   Thomas Petazzoni   ata: libahci: pro...
533
534
535
536
  		if (irq != -EPROBE_DEFER)
  			dev_err(dev, "no irq
  ");
  		return irq;
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
537
  	}
21bfd1aa9   Robert Richter   ahci: Store irq n...
538
  	hpriv->irq = irq;
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
539
  	/* prepare host */
c4121c650   Thierry Reding   ata: libahci: Sil...
540
  	pi.private_data = (void *)(unsigned long)hpriv->flags;
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
541

725c7b570   Antoine Ténart   ata: libahci_plat...
542
  	ahci_save_initial_config(dev, hpriv);
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
543
544
545
546
547
548
549
550
551
552
553
554
555
556
557
558
559
560
561
562
563
564
565
566
567
568
569
570
571
572
573
574
575
576
577
578
579
580
581
582
583
584
585
586
587
588
  
  	if (hpriv->cap & HOST_CAP_NCQ)
  		pi.flags |= ATA_FLAG_NCQ;
  
  	if (hpriv->cap & HOST_CAP_PMP)
  		pi.flags |= ATA_FLAG_PMP;
  
  	ahci_set_em_messages(hpriv, &pi);
  
  	/* CAP.NP sometimes indicate the index of the last enabled
  	 * port, at other times, that of the last possible port, so
  	 * determining the maximum port number requires looking at
  	 * both CAP.NP and port_map.
  	 */
  	n_ports = max(ahci_nr_ports(hpriv->cap), fls(hpriv->port_map));
  
  	host = ata_host_alloc_pinfo(dev, ppi, n_ports);
  	if (!host)
  		return -ENOMEM;
  
  	host->private_data = hpriv;
  
  	if (!(hpriv->cap & HOST_CAP_SSS) || ahci_ignore_sss)
  		host->flags |= ATA_HOST_PARALLEL_SCAN;
  	else
  		dev_info(dev, "SSS flag set, parallel bus scan disabled
  ");
  
  	if (pi.flags & ATA_FLAG_EM)
  		ahci_reset_em(host);
  
  	for (i = 0; i < host->n_ports; i++) {
  		struct ata_port *ap = host->ports[i];
  
  		ata_port_desc(ap, "mmio %pR",
  			      platform_get_resource(pdev, IORESOURCE_MEM, 0));
  		ata_port_desc(ap, "port 0x%x", 0x100 + ap->port_no * 0x80);
  
  		/* set enclosure management message type */
  		if (ap->flags & ATA_FLAG_EM)
  			ap->em_message_type = hpriv->em_msg_type;
  
  		/* disabled/not-implemented port */
  		if (!(hpriv->port_map & (1 << i)))
  			ap->ops = &ata_dummy_port_ops;
  	}
cc7a9e275   Suravee Suthikulpanit   ahci: Check and s...
589
590
591
592
593
594
595
596
597
598
599
600
601
602
  	if (hpriv->cap & HOST_CAP_64) {
  		rc = dma_coerce_mask_and_coherent(dev, DMA_BIT_MASK(64));
  		if (rc) {
  			rc = dma_coerce_mask_and_coherent(dev,
  							  DMA_BIT_MASK(32));
  			if (rc) {
  				dev_err(dev, "Failed to enable 64-bit DMA.
  ");
  				return rc;
  			}
  			dev_warn(dev, "Enable 32-bit DMA instead of 64-bit.
  ");
  		}
  	}
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
603
604
605
606
607
608
  	rc = ahci_reset_controller(host);
  	if (rc)
  		return rc;
  
  	ahci_init_controller(host);
  	ahci_print_info(host, "platform");
21bfd1aa9   Robert Richter   ahci: Store irq n...
609
  	return ahci_host_activate(host, sht);
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
610
611
612
613
614
  }
  EXPORT_SYMBOL_GPL(ahci_platform_init_host);
  
  static void ahci_host_stop(struct ata_host *host)
  {
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
615
  	struct ahci_host_priv *hpriv = host->private_data;
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
616
617
  	ahci_platform_disable_resources(hpriv);
  }
8eede5bc4   Nate Watterson   ata: ahci_platfor...
618
619
  /**
   * ahci_platform_shutdown - Disable interrupts and stop DMA for host ports
7cf5fc65f   Corentin Labbe   ata: ahci_platfor...
620
   * @pdev: platform device pointer for the host
8eede5bc4   Nate Watterson   ata: ahci_platfor...
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
649
650
   *
   * This function is called during system shutdown and performs the minimal
   * deconfiguration required to ensure that an ahci_platform host cannot
   * corrupt or otherwise interfere with a new kernel being started with kexec.
   */
  void ahci_platform_shutdown(struct platform_device *pdev)
  {
  	struct ata_host *host = platform_get_drvdata(pdev);
  	struct ahci_host_priv *hpriv = host->private_data;
  	void __iomem *mmio = hpriv->mmio;
  	int i;
  
  	for (i = 0; i < host->n_ports; i++) {
  		struct ata_port *ap = host->ports[i];
  
  		/* Disable port interrupts */
  		if (ap->ops->freeze)
  			ap->ops->freeze(ap);
  
  		/* Stop the port DMA engines */
  		if (ap->ops->port_stop)
  			ap->ops->port_stop(ap);
  	}
  
  	/* Disable and clear host interrupts */
  	writel(readl(mmio + HOST_CTL) & ~HOST_IRQ_EN, mmio + HOST_CTL);
  	readl(mmio + HOST_CTL); /* flush */
  	writel(GENMASK(host->n_ports, 0), mmio + HOST_IRQ_STAT);
  }
  EXPORT_SYMBOL_GPL(ahci_platform_shutdown);
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
651
652
653
654
655
656
  #ifdef CONFIG_PM_SLEEP
  /**
   * ahci_platform_suspend_host - Suspend an ahci-platform host
   * @dev: device pointer for the host
   *
   * This function does all the usual steps needed to suspend an
b1a9edbda   Antoine Ténart   ata: libahci: all...
657
   * ahci-platform host, note any necessary resources (ie clks, phys, etc.)
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
658
659
660
661
662
663
664
665
666
667
668
669
670
671
672
673
674
675
676
677
678
679
680
681
682
683
684
685
686
687
688
689
690
691
692
693
694
   * must be disabled after calling this.
   *
   * RETURNS:
   * 0 on success otherwise a negative error code
   */
  int ahci_platform_suspend_host(struct device *dev)
  {
  	struct ata_host *host = dev_get_drvdata(dev);
  	struct ahci_host_priv *hpriv = host->private_data;
  	void __iomem *mmio = hpriv->mmio;
  	u32 ctl;
  
  	if (hpriv->flags & AHCI_HFLAG_NO_SUSPEND) {
  		dev_err(dev, "firmware update required for suspend/resume
  ");
  		return -EIO;
  	}
  
  	/*
  	 * AHCI spec rev1.1 section 8.3.3:
  	 * Software must disable interrupts prior to requesting a
  	 * transition of the HBA to D3 state.
  	 */
  	ctl = readl(mmio + HOST_CTL);
  	ctl &= ~HOST_IRQ_EN;
  	writel(ctl, mmio + HOST_CTL);
  	readl(mmio + HOST_CTL); /* flush */
  
  	return ata_host_suspend(host, PMSG_SUSPEND);
  }
  EXPORT_SYMBOL_GPL(ahci_platform_suspend_host);
  
  /**
   * ahci_platform_resume_host - Resume an ahci-platform host
   * @dev: device pointer for the host
   *
   * This function does all the usual steps needed to resume an ahci-platform
b1a9edbda   Antoine Ténart   ata: libahci: all...
695
   * host, note any necessary resources (ie clks, phys, etc.)  must be
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
696
697
698
699
700
701
702
703
704
705
706
707
708
709
710
711
712
713
714
715
716
717
718
719
720
721
722
723
724
725
726
727
728
729
730
731
   * initialized / enabled before calling this.
   *
   * RETURNS:
   * 0 on success otherwise a negative error code
   */
  int ahci_platform_resume_host(struct device *dev)
  {
  	struct ata_host *host = dev_get_drvdata(dev);
  	int rc;
  
  	if (dev->power.power_state.event == PM_EVENT_SUSPEND) {
  		rc = ahci_reset_controller(host);
  		if (rc)
  			return rc;
  
  		ahci_init_controller(host);
  	}
  
  	ata_host_resume(host);
  
  	return 0;
  }
  EXPORT_SYMBOL_GPL(ahci_platform_resume_host);
  
  /**
   * ahci_platform_suspend - Suspend an ahci-platform device
   * @dev: the platform device to suspend
   *
   * This function suspends the host associated with the device, followed by
   * disabling all the resources of the device.
   *
   * RETURNS:
   * 0 on success otherwise a negative error code
   */
  int ahci_platform_suspend(struct device *dev)
  {
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
732
733
734
  	struct ata_host *host = dev_get_drvdata(dev);
  	struct ahci_host_priv *hpriv = host->private_data;
  	int rc;
eac7e072d   Tejun Heo   Revert "ata: ahci...
735
  	rc = ahci_platform_suspend_host(dev);
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
736
737
  	if (rc)
  		return rc;
eac7e072d   Tejun Heo   Revert "ata: ahci...
738
  	ahci_platform_disable_resources(hpriv);
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
739
740
  
  	return 0;
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
741
  }
eac7e072d   Tejun Heo   Revert "ata: ahci...
742
  EXPORT_SYMBOL_GPL(ahci_platform_suspend);
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
743
744
745
746
747
748
749
750
751
752
753
754
755
  
  /**
   * ahci_platform_resume - Resume an ahci-platform device
   * @dev: the platform device to resume
   *
   * This function enables all the resources of the device followed by
   * resuming the host associated with the device.
   *
   * RETURNS:
   * 0 on success otherwise a negative error code
   */
  int ahci_platform_resume(struct device *dev)
  {
eac7e072d   Tejun Heo   Revert "ata: ahci...
756
757
  	struct ata_host *host = dev_get_drvdata(dev);
  	struct ahci_host_priv *hpriv = host->private_data;
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
758
  	int rc;
eac7e072d   Tejun Heo   Revert "ata: ahci...
759
  	rc = ahci_platform_enable_resources(hpriv);
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
760
761
  	if (rc)
  		return rc;
eac7e072d   Tejun Heo   Revert "ata: ahci...
762
763
764
  	rc = ahci_platform_resume_host(dev);
  	if (rc)
  		goto disable_resources;
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
765
766
767
768
769
770
  	/* We resumed so update PM runtime state */
  	pm_runtime_disable(dev);
  	pm_runtime_set_active(dev);
  	pm_runtime_enable(dev);
  
  	return 0;
aece27a2f   Samuel Morris   ata: ahci_platfor...
771

eac7e072d   Tejun Heo   Revert "ata: ahci...
772
773
  disable_resources:
  	ahci_platform_disable_resources(hpriv);
aece27a2f   Samuel Morris   ata: ahci_platfor...
774

eac7e072d   Tejun Heo   Revert "ata: ahci...
775
776
777
  	return rc;
  }
  EXPORT_SYMBOL_GPL(ahci_platform_resume);
fd990556f   Bartlomiej Zolnierkiewicz   ata: move library...
778
779
780
781
782
  #endif
  
  MODULE_DESCRIPTION("AHCI SATA platform library");
  MODULE_AUTHOR("Anton Vorontsov <avorontsov@ru.mvista.com>");
  MODULE_LICENSE("GPL");