pinctrl: altas7: add sd9 function mux support

The sd9 pin mux with sd3 and it is selected by SYS2PCI_SDIO9SEL.
This makes the codes ugly since the register is not in pinctrl
module.

Signed-off-by: Yonghui Zhang <yonghui.zhang@csr.com>
Signed-off-by: Barry Song <Baohua.Song@csr.com>
Signed-off-by: Linus Walleij <linus.walleij@linaro.org>

diff --git a/drivers/pinctrl/sirf/pinctrl-atlas7.c b/drivers/pinctrl/sirf/pinctrl-atlas7.c
index 30db524..47c63c5 100644 (file)
--- a/drivers/pinctrl/sirf/pinctrl-atlas7.c
+++ b/drivers/pinctrl/sirf/pinctrl-atlas7.c
@@ -161,6 +161,9 @@ enum altas7_pad_type {
 #define IN_DISABLE_VAL_1_REG_SET       0x0A88
 #define IN_DISABLE_VAL_1_REG_CLR       0x0A8C
 
+/* Offset of the SDIO9SEL*/
+#define SYS2PCI_SDIO9SEL 0x14
+
 struct dt_params {
        const char *property;
        int value;
@@ -370,6 +373,7 @@ struct atlas7_pmx {
        struct pinctrl_desc pctl_desc;
        struct atlas7_pinctrl_data *pctl_data;
        void __iomem *regs[ATLAS7_PINCTRL_REG_BANKS];
+       void __iomem *sys2pci_base;
        u32 status_ds[NUM_OF_IN_DISABLE_REG];
        u32 status_dsv[NUM_OF_IN_DISABLE_REG];
        struct atlas7_pad_status sleep_data[ATLAS7_PINCTRL_TOTAL_PINS];
@@ -946,7 +950,7 @@ static const unsigned int sd2_cdb_pins0[] = { 124, };
 static const unsigned int sd2_cdb_pins1[] = { 161, };
 static const unsigned int sd2_wpb_pins0[] = { 123, };
 static const unsigned int sd2_wpb_pins1[] = { 163, };
-static const unsigned int sd3_pins[] = { 85, 86, 87, 88, 89, 90, };
+static const unsigned int sd3_9_pins[] = { 85, 86, 87, 88, 89, 90, };
 static const unsigned int sd5_pins[] = { 91, 92, 93, 94, 95, 96, };
 static const unsigned int sd6_pins0[] = { 79, 78, 74, 75, 76, 77, };
 static const unsigned int sd6_pins1[] = { 101, 99, 100, 110, 109, 111, };
@@ -1199,7 +1203,7 @@ struct atlas7_pin_group altas7_pin_groups[] = {
        GROUP("sd2_cdb_grp1", sd2_cdb_pins1),
        GROUP("sd2_wpb_grp0", sd2_wpb_pins0),
        GROUP("sd2_wpb_grp1", sd2_wpb_pins1),
-       GROUP("sd3_grp", sd3_pins),
+       GROUP("sd3_9_grp", sd3_9_pins),
        GROUP("sd5_grp", sd5_pins),
        GROUP("sd6_grp0", sd6_pins0),
        GROUP("sd6_grp1", sd6_pins1),
@@ -1482,7 +1486,7 @@ static const char * const sd2_cdb_grp0[] = { "sd2_cdb_grp0", };
 static const char * const sd2_cdb_grp1[] = { "sd2_cdb_grp1", };
 static const char * const sd2_wpb_grp0[] = { "sd2_wpb_grp0", };
 static const char * const sd2_wpb_grp1[] = { "sd2_wpb_grp1", };
-static const char * const sd3_grp[] = { "sd3_grp", };
+static const char * const sd3_9_grp[] = { "sd3_9_grp", };
 static const char * const sd5_grp[] = { "sd5_grp", };
 static const char * const sd6_grp0[] = { "sd6_grp0", };
 static const char * const sd6_grp1[] = { "sd6_grp1", };
@@ -3771,7 +3775,7 @@ static struct atlas7_grp_mux sd2_wpb_grp1_mux = {
        .pad_mux_list = sd2_wpb_grp1_pad_mux,
 };
 
-static struct atlas7_pad_mux sd3_grp_pad_mux[] = {
+static struct atlas7_pad_mux sd3_9_grp_pad_mux[] = {
        MUX(1, 85, 1, N, N, N, N),
        MUX(1, 86, 1, N, N, N, N),
        MUX(1, 87, 1, N, N, N, N),
@@ -3780,9 +3784,9 @@ static struct atlas7_pad_mux sd3_grp_pad_mux[] = {
        MUX(1, 90, 1, N, N, N, N),
 };
 
-static struct atlas7_grp_mux sd3_grp_mux = {
-       .pad_mux_count = ARRAY_SIZE(sd3_grp_pad_mux),
-       .pad_mux_list = sd3_grp_pad_mux,
+static struct atlas7_grp_mux sd3_9_grp_mux = {
+       .pad_mux_count = ARRAY_SIZE(sd3_9_grp_pad_mux),
+       .pad_mux_list = sd3_9_grp_pad_mux,
 };
 
 static struct atlas7_pad_mux sd5_grp_pad_mux[] = {
@@ -4715,10 +4719,11 @@ static struct atlas7_pmx_func atlas7_pmx_functions[] = {
        FUNCTION("sd2_cdb_m1", sd2_cdb_grp1, &sd2_cdb_grp1_mux),
        FUNCTION("sd2_wpb_m0", sd2_wpb_grp0, &sd2_wpb_grp0_mux),
        FUNCTION("sd2_wpb_m1", sd2_wpb_grp1, &sd2_wpb_grp1_mux),
-       FUNCTION("sd3", sd3_grp, &sd3_grp_mux),
+       FUNCTION("sd3", sd3_9_grp, &sd3_9_grp_mux),
        FUNCTION("sd5", sd5_grp, &sd5_grp_mux),
        FUNCTION("sd6_m0", sd6_grp0, &sd6_grp0_mux),
        FUNCTION("sd6_m1", sd6_grp1, &sd6_grp1_mux),
+       FUNCTION("sd9", sd3_9_grp, &sd3_9_grp_mux),
        FUNCTION("sp0_ext_ldo_on",
                        sp0_ext_ldo_on_grp,
                        &sp0_ext_ldo_on_grp_mux),
@@ -5126,6 +5131,14 @@ static int atlas7_pmx_set_mux(struct pinctrl_dev *pctldev,
        pr_debug("PMX DUMP ### Function:[%s] Group:[%s] #### START >>>\n",
                        pmx_func->name, pin_grp->name);
 
+       /* the sd3 and sd9 pin select by SYS2PCI_SDIO9SEL register */
+       if (pin_grp->pins == (unsigned int *)&sd3_9_pins) {
+               if (!strcmp(pmx_func->name, "sd9"))
+                       writel(1, pmx->sys2pci_base + SYS2PCI_SDIO9SEL);
+               else
+                       writel(0, pmx->sys2pci_base + SYS2PCI_SDIO9SEL);
+       }
+
        grp_mux = pmx_func->grpmux;
 
        for (idx = 0; idx < grp_mux->pad_mux_count; idx++) {
@@ -5414,12 +5427,27 @@ static int atlas7_pinmux_probe(struct platform_device *pdev)
        struct atlas7_pmx *pmx;
        struct device_node *np = pdev->dev.of_node;
        u32 banks = ATLAS7_PINCTRL_REG_BANKS;
+       struct device_node *sys2pci_np;
+       struct resource res;
 
        /* Create state holders etc for this driver */
        pmx = devm_kzalloc(&pdev->dev, sizeof(*pmx), GFP_KERNEL);
        if (!pmx)
                return -ENOMEM;
 
+       /* The sd3 and sd9 shared all pins, and the function select by
+        * SYS2PCI_SDIO9SEL register
+        */
+       sys2pci_np = of_find_node_by_name(NULL, "sys2pci");
+       if (!sys2pci_np)
+               return -EINVAL;
+       ret = of_address_to_resource(sys2pci_np, 0, &res);
+       if (ret)
+               return ret;
+       pmx->sys2pci_base = devm_ioremap_resource(&pdev->dev, &res);
+       if (IS_ERR(pmx->sys2pci_base))
+               return -ENOMEM;
+
        pmx->dev = &pdev->dev;
 
        pmx->pctl_data = &atlas7_ioc_data;