drivers/platform/sprd/sec-reboot.c

   1 #include <linux/delay.h>
   2 #include <linux/pm.h>
   3 #include <asm/io.h>
   4 #include <mach/io.h>
   5 #include <asm/cacheflush.h>
   6 #include <soc/sprd/system.h>
   7 #include <linux/notifier.h>
   8 #include <linux/reboot.h>
   9 #include <mach/gpio.h>
  10 #include <soc/sprd/sec_debug.h>
  11
  12 #if 0 /* should be fixed later */
  13 /* charger cable state */
  14 extern bool is_cable_attached;
  15
  16 static void sec_power_off(void)
  17 {
  18         int poweroff_try = 0;
  19
  20         local_irq_disable();
  21
  22         pr_emerg("%s : cable state=%d\n", __func__, is_cable_attached);
  23         flush_cache_all();
  24         outer_flush_all();
  25
  26         while (1) {
  27                 /* Check reboot charging */
  28                 if (is_cable_attached || (poweroff_try >= 5)) {
  29                         pr_emerg
  30                             ("%s: charger connected(%d) or power"
  31                              "off failed(%d), reboot!\n",
  32                              __func__, is_cable_attached, poweroff_try);
  33                         writel(0x0, (void __iomem *)S5P_INFORM2);       /* To enter LP charging */
  34
  35                         flush_cache_all();
  36                         outer_flush_all();
  37                         arch_reset(0, 0);
  38
  39                         pr_emerg("%s: waiting for reboot\n", __func__);
  40                         while (1);
  41                 }
  42
  43                 /* wait for power button release */
  44                 if (gpio_get_value(GPIO_nPOWER)) {
  45                         pr_emerg("%s: set PS_HOLD low\n", __func__);
  46
  47                         /* power off code
  48                          * PS_HOLD Out/High -->
  49                          * Low PS_HOLD_CONTROL, R/W, 0x1002_330C
  50                          */
  51                         writel(readl(S5P_PS_HOLD_CONTROL) & 0xFFFFFEFF,
  52                                (void __iomem *)S5P_PS_HOLD_CONTROL);
  53
  54                         ++poweroff_try;
  55                         pr_emerg
  56                             ("%s: Should not reach here! (poweroff_try:%d)\n",
  57                              __func__, poweroff_try);
  58                 } else {
  59                         /* if power button is not released, wait and check TA again */
  60                         pr_info("%s: PowerButton is not released.\n", __func__);
  61                 }
  62                 mdelay(1000);
  63         }
  64 }
  65
  66 #endif  /* should be fixed later */
  67
  68 #define REBOOT_MODE_PREFIX      0x12345670
  69 #define REBOOT_MODE_NONE                0
  70 #define REBOOT_MODE_DOWNLOAD    1
  71 #define REBOOT_MODE_UPLOAD              2
  72 #define REBOOT_MODE_CHARGING    3
  73 #define REBOOT_MODE_RECOVERY    4
  74 #define REBOOT_MODE_FOTA                5
  75 #define REBOOT_MODE_FOTA_BL             6
  76 #define REBOOT_MODE_NORMAL              8
  77 #define REBOOT_MODE_FUS_RW              9
  78 #define REBOOT_MODE_SILENT              0xA
  79
  80 #define REBOOT_SET_PREFIX       0xabc00000
  81 #define REBOOT_SET_DEBUG        0x000d0000
  82 #define REBOOT_SET_SWSEL        0x000e0000
  83 #define REBOOT_SET_SUD          0x000f0000
  84
  85 //extern int sec_debug_level(void);
  86
  87 static int sec_reboot_notifier(struct notifier_block *nb,
  88                                                         unsigned long l, void *buf)
  89 {
  90         char *cmd = buf;
  91
  92
  93         pr_emerg("%s (%lu, %s)\n", __func__, l, cmd ? cmd : "(null)");
  94
  95         writel(0x12345678,(void __iomem *)SPRD_INFORM2);        /* Don't enter lpm mode */
  96
  97         if (!cmd) {
  98                 writel(REBOOT_MODE_PREFIX | REBOOT_MODE_NONE, (void __iomem *)SPRD_INFORM3);
  99         } else {
 100                 if (!strcmp(cmd, "download"))
 101                         writel(REBOOT_MODE_PREFIX | REBOOT_MODE_DOWNLOAD,
 102                                (void __iomem *)SPRD_INFORM3);
 103                 else if (!strcmp(cmd, "silent"))
 104                         writel(REBOOT_MODE_PREFIX | REBOOT_MODE_SILENT,
 105                                (void __iomem *)SPRD_INFORM3);
 106                 else
 107                         writel(REBOOT_MODE_PREFIX | REBOOT_MODE_NONE,
 108                                (void __iomem *)SPRD_INFORM3);
 109         }
 110         flush_cache_all();
 111         return NOTIFY_DONE;
 112
 113 }
 114
 115 static struct notifier_block nb_sec_reboot_block = {
 116         .notifier_call = sec_reboot_notifier
 117 };
 118 static int __init sec_reboot_init(void)
 119 {
 120         /* to support system shut down */
 121         register_reboot_notifier(&nb_sec_reboot_block);
 122         return 0;
 123 }
 124
 125 subsys_initcall(sec_reboot_init);
 126