target/linux/ramips/patches-3.10/0002-MIPS-ralink-add-pinmux-driver.patch

   1 From 9a3055dad80db43aeb22b247512e18e8f06bf54c Mon Sep 17 00:00:00 2001
   2 From: John Crispin <blogic@openwrt.org>
   3 Date: Mon, 22 Apr 2013 23:11:42 +0200
   4 Subject: [PATCH 02/33] MIPS: ralink: add pinmux driver
   5
   6 Add code to setup the pinmux on ralonk SoC. The SoC has a single 32 bit register
   7 for this functionality with simple on/off bits. Building a full featured pinctrl
   8 driver would be overkill.
   9
  10 Signed-off-by: John Crispin <blogic@openwrt.org>
  11 ---
  12  arch/mips/ralink/Makefile |    2 +-
  13  arch/mips/ralink/common.h |    2 ++
  14  arch/mips/ralink/of.c     |    2 ++
  15  arch/mips/ralink/pinmux.c |   77 +++++++++++++++++++++++++++++++++++++++++++++
  16  4 files changed, 82 insertions(+), 1 deletion(-)
  17  create mode 100644 arch/mips/ralink/pinmux.c
  18
  19 --- a/arch/mips/ralink/Makefile
  20 +++ b/arch/mips/ralink/Makefile
  21 @@ -6,7 +6,7 @@
  22  # Copyright (C) 2009-2011 Gabor Juhos <juhosg@openwrt.org>
  23  # Copyright (C) 2013 John Crispin <blogic@openwrt.org>
  24
  25 -obj-y := prom.o of.o reset.o clk.o irq.o
  26 +obj-y := prom.o of.o reset.o clk.o irq.o pinmux.o
  27
  28  obj-$(CONFIG_SOC_RT288X) += rt288x.o
  29  obj-$(CONFIG_SOC_RT305X) += rt305x.o
  30 --- a/arch/mips/ralink/common.h
  31 +++ b/arch/mips/ralink/common.h
  32 @@ -50,4 +50,6 @@ extern void prom_soc_init(struct ralink_
  33
  34  __iomem void *plat_of_remap_node(const char *node);
  35
  36 +void ralink_pinmux(void);
  37 +
  38  #endif /* _RALINK_COMMON_H__ */
  39 --- a/arch/mips/ralink/of.c
  40 +++ b/arch/mips/ralink/of.c
  41 @@ -110,6 +110,8 @@ static int __init plat_of_setup(void)
  42         if (of_platform_populate(NULL, of_ids, NULL, NULL))
  43                 panic("failed to populate DT\n");
  44
  45 +       ralink_pinmux();
  46 +
  47         return 0;
  48  }
  49
  50 --- /dev/null
  51 +++ b/arch/mips/ralink/pinmux.c
  52 @@ -0,0 +1,92 @@
  53 +/*
  54 + *  This program is free software; you can redistribute it and/or modify it
  55 + *  under the terms of the GNU General Public License version 2 as published
  56 + *  by the Free Software Foundation.
  57 + *
  58 + *  Copyright (C) 2013 John Crispin <blogic@openwrt.org>
  59 + */
  60 +
  61 +#include <linux/kernel.h>
  62 +#include <linux/of.h>
  63 +
  64 +#include <asm/mach-ralink/ralink_regs.h>
  65 +
  66 +#include "common.h"
  67 +
  68 +#define SYSC_REG_GPIO_MODE     0x60
  69 +
  70 +static int ralink_mux_mask(const char *name, struct ralink_pinmux_grp *grps, u32* mask)
  71 +{
  72 +       for (; grps && grps->name; grps++)
  73 +               if (!strcmp(grps->name, name)) {
  74 +                       *mask = grps->mask;
  75 +                       return 0;
  76 +               }
  77 +
  78 +       return -1;
  79 +}
  80 +
  81 +void ralink_pinmux(void)
  82 +{
  83 +       const __be32 *wdt;
  84 +       struct device_node *np;
  85 +       struct property *prop;
  86 +       const char *uart, *pci, *pin;
  87 +       u32 mode = 0;
  88 +       int m;
  89 +
  90 +       np = of_find_compatible_node(NULL, NULL, "ralink,rt3050-sysc");
  91 +       if (!np)
  92 +               return;
  93 +
  94 +       of_property_for_each_string(np, "ralink,gpiomux", prop, pin) {
  95 +               if (!ralink_mux_mask(pin, rt_gpio_pinmux.mode, &m)) {
  96 +                       mode |= m;
  97 +                       pr_debug("pinmux: registered gpiomux \"%s\"\n", pin);
  98 +               } else {
  99 +                       pr_err("pinmux: failed to load \"%s\"\n", pin);
 100 +               }
 101 +       }
 102 +
 103 +       of_property_for_each_string(np, "ralink,pinmux", prop, pin) {
 104 +               if (!ralink_mux_mask(pin, rt_gpio_pinmux.mode, &m)) {
 105 +                       mode &= ~m;
 106 +                       pr_debug("pinmux: registered pinmux \"%s\"\n", pin);
 107 +               } else {
 108 +                       pr_err("pinmux: failed to load group \"%s\"\n", pin);
 109 +               }
 110 +       }
 111 +
 112 +       of_property_read_string(np, "ralink,uartmux", &uart);
 113 +       if (uart) {
 114 +               mode &= ~(rt_gpio_pinmux.uart_mask << rt_gpio_pinmux.uart_shift);
 115 +               if (ralink_mux_mask(uart, rt_gpio_pinmux.uart, &m)) {
 116 +                       pr_err("pinmux: failed to load uartmux \"%s\"\n", uart);
 117 +                       mode |= rt_gpio_pinmux.uart_mask << rt_gpio_pinmux.uart_shift;
 118 +               } else {
 119 +                       mode |= m << rt_gpio_pinmux.uart_shift;
 120 +                       pr_debug("pinmux: registered uartmux \"%s\"\n", uart);
 121 +               }
 122 +       }
 123 +
 124 +       wdt = of_get_property(np, "ralink,wdtmux", NULL);
 125 +       if (wdt && *wdt && rt_gpio_pinmux.wdt_reset)
 126 +               rt_gpio_pinmux.wdt_reset();
 127 +
 128 +       pci = NULL;
 129 +       if (rt_gpio_pinmux.pci)
 130 +               of_property_read_string(np, "ralink,pcimux", &pci);
 131 +
 132 +       if (pci) {
 133 +               mode &= ~(rt_gpio_pinmux.pci_mask << rt_gpio_pinmux.pci_shift);
 134 +               if (ralink_mux_mask(pci, rt_gpio_pinmux.pci, &m)) {
 135 +                       mode |= rt_gpio_pinmux.pci_mask << rt_gpio_pinmux.pci_shift;
 136 +                       pr_debug("pinmux: failed to load pcimux \"%s\"\n", pci);
 137 +               } else {
 138 +                       mode |= m << rt_gpio_pinmux.pci_shift;
 139 +                       pr_debug("pinmux: registered pcimux \"%s\"\n", pci);
 140 +               }
 141 +       }
 142 +
 143 +       rt_sysc_w32(mode, SYSC_REG_GPIO_MODE);
 144 +}