arch/arm/mach-mvebu/pm-board.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * Board-level suspend/resume support.
   4  *
   5  * Copyright (C) 2014-2015 Marvell
   6  *
   7  * Thomas Petazzoni <thomas.petazzoni@free-electrons.com>
   8  */
   9
  10 #include <linux/delay.h>
  11 #include <linux/gpio.h>
  12 #include <linux/init.h>
  13 #include <linux/io.h>
  14 #include <linux/of.h>
  15 #include <linux/of_address.h>
  16 #include <linux/of_gpio.h>
  17 #include <linux/slab.h>
  18 #include "common.h"
  19
  20 #define ARMADA_PIC_NR_GPIOS 3
  21
  22 static void __iomem *gpio_ctrl;
  23 static int pic_gpios[ARMADA_PIC_NR_GPIOS];
  24 static int pic_raw_gpios[ARMADA_PIC_NR_GPIOS];
  25
  26 static void mvebu_armada_pm_enter(void __iomem *sdram_reg, u32 srcmd)
  27 {
  28         u32 reg, ackcmd;
  29         int i;
  30
  31         /* Put 001 as value on the GPIOs */
  32         reg = readl(gpio_ctrl);
  33         for (i = 0; i < ARMADA_PIC_NR_GPIOS; i++)
  34                 reg &= ~BIT(pic_raw_gpios[i]);
  35         reg |= BIT(pic_raw_gpios[0]);
  36         writel(reg, gpio_ctrl);
  37
  38         /* Prepare writing 111 to the GPIOs */
  39         ackcmd = readl(gpio_ctrl);
  40         for (i = 0; i < ARMADA_PIC_NR_GPIOS; i++)
  41                 ackcmd |= BIT(pic_raw_gpios[i]);
  42
  43         srcmd = cpu_to_le32(srcmd);
  44         ackcmd = cpu_to_le32(ackcmd);
  45
  46         /*
  47          * Wait a while, the PIC needs quite a bit of time between the
  48          * two GPIO commands.
  49          */
  50         mdelay(3000);
  51
  52         asm volatile (
  53                 /* Align to a cache line */
  54                 ".balign 32\n\t"
  55
  56                 /* Enter self refresh */
  57                 "str %[srcmd], [%[sdram_reg]]\n\t"
  58
  59                 /*
  60                  * Wait 100 cycles for DDR to enter self refresh, by
  61                  * doing 50 times two instructions.
  62                  */
  63                 "mov r1, #50\n\t"
  64                 "1: subs r1, r1, #1\n\t"
  65                 "bne 1b\n\t"
  66
  67                 /* Issue the command ACK */
  68                 "str %[ackcmd], [%[gpio_ctrl]]\n\t"
  69
  70                 /* Trap the processor */
  71                 "b .\n\t"
  72                 : : [srcmd] "r" (srcmd), [sdram_reg] "r" (sdram_reg),
  73                   [ackcmd] "r" (ackcmd), [gpio_ctrl] "r" (gpio_ctrl) : "r1");
  74 }
  75
  76 static int __init mvebu_armada_pm_init(void)
  77 {
  78         struct device_node *np;
  79         struct device_node *gpio_ctrl_np = NULL;
  80         int ret = 0, i;
  81
  82         if (!of_machine_is_compatible("marvell,axp-gp"))
  83                 return -ENODEV;
  84
  85         np = of_find_node_by_name(NULL, "pm_pic");
  86         if (!np)
  87                 return -ENODEV;
  88
  89         for (i = 0; i < ARMADA_PIC_NR_GPIOS; i++) {
  90                 char *name;
  91                 struct of_phandle_args args;
  92
  93                 pic_gpios[i] = of_get_named_gpio(np, "ctrl-gpios", i);
  94                 if (pic_gpios[i] < 0) {
  95                         ret = -ENODEV;
  96                         goto out;
  97                 }
  98
  99                 name = kasprintf(GFP_KERNEL, "pic-pin%d", i);
 100                 if (!name) {
 101                         ret = -ENOMEM;
 102                         goto out;
 103                 }
 104
 105                 ret = gpio_request(pic_gpios[i], name);
 106                 if (ret < 0) {
 107                         kfree(name);
 108                         goto out;
 109                 }
 110
 111                 ret = gpio_direction_output(pic_gpios[i], 0);
 112                 if (ret < 0) {
 113                         gpio_free(pic_gpios[i]);
 114                         kfree(name);
 115                         goto out;
 116                 }
 117
 118                 ret = of_parse_phandle_with_fixed_args(np, "ctrl-gpios", 2,
 119                                                        i, &args);
 120                 if (ret < 0) {
 121                         gpio_free(pic_gpios[i]);
 122                         kfree(name);
 123                         goto out;
 124                 }
 125
 126                 if (gpio_ctrl_np)
 127                         of_node_put(gpio_ctrl_np);
 128                 gpio_ctrl_np = args.np;
 129                 pic_raw_gpios[i] = args.args[0];
 130         }
 131
 132         gpio_ctrl = of_iomap(gpio_ctrl_np, 0);
 133         if (!gpio_ctrl) {
 134                 ret = -ENOMEM;
 135                 goto out;
 136         }
 137
 138         mvebu_pm_suspend_init(mvebu_armada_pm_enter);
 139
 140 out:
 141         of_node_put(np);
 142         of_node_put(gpio_ctrl_np);
 143         return ret;
 144 }
 145
 146 /*
 147  * Registering the mvebu_board_pm_enter callback must be done before
 148  * the platform_suspend_ops will be registered. In the same time we
 149  * also need to have the gpio devices registered. That's why we use a
 150  * device_initcall_sync which is called after all the device_initcall
 151  * (used by the gpio device) but before the late_initcall (used to
 152  * register the platform_suspend_ops)
 153  */
 154 device_initcall_sync(mvebu_armada_pm_init);