2 * Board-level suspend/resume support.
4 * Copyright (C) 2014 Marvell
6 * Thomas Petazzoni <thomas.petazzoni@free-electrons.com>
8 * This file is licensed under the terms of the GNU General Public
9 * License version 2. This program is licensed "as is" without any
10 * warranty of any kind, whether express or implied.
13 #include <linux/delay.h>
14 #include <linux/gpio.h>
15 #include <linux/init.h>
18 #include <linux/of_address.h>
19 #include <linux/of_gpio.h>
20 #include <linux/slab.h>
23 #define ARMADA_XP_GP_PIC_NR_GPIOS 3
25 static void __iomem *gpio_ctrl;
26 static int pic_gpios[ARMADA_XP_GP_PIC_NR_GPIOS];
27 static int pic_raw_gpios[ARMADA_XP_GP_PIC_NR_GPIOS];
29 static void mvebu_armada_xp_gp_pm_enter(void __iomem *sdram_reg, u32 srcmd)
34 /* Put 001 as value on the GPIOs */
35 reg = readl(gpio_ctrl);
36 for (i = 0; i < ARMADA_XP_GP_PIC_NR_GPIOS; i++)
37 reg &= ~BIT(pic_raw_gpios[i]);
38 reg |= BIT(pic_raw_gpios[0]);
39 writel(reg, gpio_ctrl);
41 /* Prepare writing 111 to the GPIOs */
42 ackcmd = readl(gpio_ctrl);
43 for (i = 0; i < ARMADA_XP_GP_PIC_NR_GPIOS; i++)
44 ackcmd |= BIT(pic_raw_gpios[i]);
47 * Wait a while, the PIC needs quite a bit of time between the
53 /* Align to a cache line */
56 /* Enter self refresh */
57 "str %[srcmd], [%[sdram_reg]]\n\t"
60 * Wait 100 cycles for DDR to enter self refresh, by
61 * doing 50 times two instructions.
64 "1: subs r1, r1, #1\n\t"
67 /* Issue the command ACK */
68 "str %[ackcmd], [%[gpio_ctrl]]\n\t"
70 /* Trap the processor */
72 : : [srcmd] "r" (srcmd), [sdram_reg] "r" (sdram_reg),
73 [ackcmd] "r" (ackcmd), [gpio_ctrl] "r" (gpio_ctrl) : "r1");
76 static int mvebu_armada_xp_gp_pm_init(void)
78 struct device_node *np;
79 struct device_node *gpio_ctrl_np;
82 if (!of_machine_is_compatible("marvell,axp-gp"))
85 np = of_find_node_by_name(NULL, "pm_pic");
89 for (i = 0; i < ARMADA_XP_GP_PIC_NR_GPIOS; i++) {
91 struct of_phandle_args args;
93 pic_gpios[i] = of_get_named_gpio(np, "ctrl-gpios", i);
94 if (pic_gpios[i] < 0) {
99 name = kasprintf(GFP_KERNEL, "pic-pin%d", i);
105 ret = gpio_request(pic_gpios[i], name);
111 ret = gpio_direction_output(pic_gpios[i], 0);
113 gpio_free(pic_gpios[i]);
118 ret = of_parse_phandle_with_fixed_args(np, "ctrl-gpios", 2,
121 gpio_free(pic_gpios[i]);
126 gpio_ctrl_np = args.np;
127 pic_raw_gpios[i] = args.args[0];
130 gpio_ctrl = of_iomap(gpio_ctrl_np, 0);
134 mvebu_pm_init(mvebu_armada_xp_gp_pm_enter);
141 late_initcall(mvebu_armada_xp_gp_pm_init);