Blame view

kernel/linux-rt-4.4.41/drivers/usb/host/xhci-mvebu.c 1.79 KB
5113f6f70   김현기   kernel add
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
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
  /*
   * Copyright (C) 2014 Marvell
   * Author: Gregory CLEMENT <gregory.clement@free-electrons.com>
   *
   * This program is free software; you can redistribute it and/or
   * modify it under the terms of the GNU General Public License
   * version 2 as published by the Free Software Foundation.
   */
  
  #include <linux/io.h>
  #include <linux/mbus.h>
  #include <linux/of.h>
  #include <linux/platform_device.h>
  
  #include "xhci-mvebu.h"
  
  #define USB3_MAX_WINDOWS	4
  #define USB3_WIN_CTRL(w)	(0x0 + ((w) * 8))
  #define USB3_WIN_BASE(w)	(0x4 + ((w) * 8))
  
  static void xhci_mvebu_mbus_config(void __iomem *base,
  			const struct mbus_dram_target_info *dram)
  {
  	int win;
  
  	/* Clear all existing windows */
  	for (win = 0; win < USB3_MAX_WINDOWS; win++) {
  		writel(0, base + USB3_WIN_CTRL(win));
  		writel(0, base + USB3_WIN_BASE(win));
  	}
  
  	/* Program each DRAM CS in a seperate window */
  	for (win = 0; win < dram->num_cs; win++) {
  		const struct mbus_dram_window *cs = dram->cs + win;
  
  		writel(((cs->size - 1) & 0xffff0000) | (cs->mbus_attr << 8) |
  		       (dram->mbus_dram_target_id << 4) | 1,
  		       base + USB3_WIN_CTRL(win));
  
  		writel((cs->base & 0xffff0000), base + USB3_WIN_BASE(win));
  	}
  }
  
  int xhci_mvebu_mbus_init_quirk(struct platform_device *pdev)
  {
  	struct resource	*res;
  	void __iomem *base;
  	const struct mbus_dram_target_info *dram;
  
  	res = platform_get_resource(pdev, IORESOURCE_MEM, 1);
  	if (!res)
  		return -ENODEV;
  
  	/*
  	 * We don't use devm_ioremap() because this mapping should
  	 * only exists for the duration of this probe function.
  	 */
  	base = ioremap(res->start, resource_size(res));
  	if (!base)
  		return -ENODEV;
  
  	dram = mv_mbus_dram_info();
  	xhci_mvebu_mbus_config(base, dram);
  
  	/*
  	 * This memory area was only needed to configure the MBus
  	 * windows, and is therefore no longer useful.
  	 */
  	iounmap(base);
  
  	return 0;
  }