Loading...
1/*
2 * Copyright (C) 2014 Marvell
3 * Author: Gregory CLEMENT <gregory.clement@free-electrons.com>
4 *
5 * This program is free software; you can redistribute it and/or
6 * modify it under the terms of the GNU General Public License
7 * version 2 as published by the Free Software Foundation.
8 */
9
10#include <linux/io.h>
11#include <linux/mbus.h>
12#include <linux/of.h>
13#include <linux/platform_device.h>
14
15#include "xhci-mvebu.h"
16
17#define USB3_MAX_WINDOWS 4
18#define USB3_WIN_CTRL(w) (0x0 + ((w) * 8))
19#define USB3_WIN_BASE(w) (0x4 + ((w) * 8))
20
21static void xhci_mvebu_mbus_config(void __iomem *base,
22 const struct mbus_dram_target_info *dram)
23{
24 int win;
25
26 /* Clear all existing windows */
27 for (win = 0; win < USB3_MAX_WINDOWS; win++) {
28 writel(0, base + USB3_WIN_CTRL(win));
29 writel(0, base + USB3_WIN_BASE(win));
30 }
31
32 /* Program each DRAM CS in a seperate window */
33 for (win = 0; win < dram->num_cs; win++) {
34 const struct mbus_dram_window *cs = dram->cs + win;
35
36 writel(((cs->size - 1) & 0xffff0000) | (cs->mbus_attr << 8) |
37 (dram->mbus_dram_target_id << 4) | 1,
38 base + USB3_WIN_CTRL(win));
39
40 writel((cs->base & 0xffff0000), base + USB3_WIN_BASE(win));
41 }
42}
43
44int xhci_mvebu_mbus_init_quirk(struct platform_device *pdev)
45{
46 struct resource *res;
47 void __iomem *base;
48 const struct mbus_dram_target_info *dram;
49
50 res = platform_get_resource(pdev, IORESOURCE_MEM, 1);
51 if (!res)
52 return -ENODEV;
53
54 /*
55 * We don't use devm_ioremap() because this mapping should
56 * only exists for the duration of this probe function.
57 */
58 base = ioremap(res->start, resource_size(res));
59 if (!base)
60 return -ENODEV;
61
62 dram = mv_mbus_dram_info();
63 xhci_mvebu_mbus_config(base, dram);
64
65 /*
66 * This memory area was only needed to configure the MBus
67 * windows, and is therefore no longer useful.
68 */
69 iounmap(base);
70
71 return 0;
72}
1/*
2 * Copyright (C) 2014 Marvell
3 * Author: Gregory CLEMENT <gregory.clement@free-electrons.com>
4 *
5 * This program is free software; you can redistribute it and/or
6 * modify it under the terms of the GNU General Public License
7 * version 2 as published by the Free Software Foundation.
8 */
9
10#include <linux/io.h>
11#include <linux/mbus.h>
12#include <linux/of.h>
13#include <linux/platform_device.h>
14
15#include <linux/usb.h>
16#include <linux/usb/hcd.h>
17
18#include "xhci-mvebu.h"
19
20#define USB3_MAX_WINDOWS 4
21#define USB3_WIN_CTRL(w) (0x0 + ((w) * 8))
22#define USB3_WIN_BASE(w) (0x4 + ((w) * 8))
23
24static void xhci_mvebu_mbus_config(void __iomem *base,
25 const struct mbus_dram_target_info *dram)
26{
27 int win;
28
29 /* Clear all existing windows */
30 for (win = 0; win < USB3_MAX_WINDOWS; win++) {
31 writel(0, base + USB3_WIN_CTRL(win));
32 writel(0, base + USB3_WIN_BASE(win));
33 }
34
35 /* Program each DRAM CS in a seperate window */
36 for (win = 0; win < dram->num_cs; win++) {
37 const struct mbus_dram_window *cs = dram->cs + win;
38
39 writel(((cs->size - 1) & 0xffff0000) | (cs->mbus_attr << 8) |
40 (dram->mbus_dram_target_id << 4) | 1,
41 base + USB3_WIN_CTRL(win));
42
43 writel((cs->base & 0xffff0000), base + USB3_WIN_BASE(win));
44 }
45}
46
47int xhci_mvebu_mbus_init_quirk(struct usb_hcd *hcd)
48{
49 struct device *dev = hcd->self.controller;
50 struct platform_device *pdev = to_platform_device(dev);
51 struct resource *res;
52 void __iomem *base;
53 const struct mbus_dram_target_info *dram;
54
55 res = platform_get_resource(pdev, IORESOURCE_MEM, 1);
56 if (!res)
57 return -ENODEV;
58
59 /*
60 * We don't use devm_ioremap() because this mapping should
61 * only exists for the duration of this probe function.
62 */
63 base = ioremap(res->start, resource_size(res));
64 if (!base)
65 return -ENODEV;
66
67 dram = mv_mbus_dram_info();
68 xhci_mvebu_mbus_config(base, dram);
69
70 /*
71 * This memory area was only needed to configure the MBus
72 * windows, and is therefore no longer useful.
73 */
74 iounmap(base);
75
76 return 0;
77}