LXR linux/drivers/usb/host/xhci-mvebu.c

   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}
  73