2 * Blackfin bf609 power management
4 * Copyright 2011 Analog Devices Inc.
6 * Licensed under the GPL-2
9 #include <linux/suspend.h>
11 #include <linux/interrupt.h>
12 #include <linux/gpio.h>
13 #include <linux/irq.h>
15 #include <linux/delay.h>
20 #include <asm/blackfin.h>
22 /***********************************************************/
24 /* Wakeup Actions for DPM_RESTORE */
26 /***********************************************************/
27 #define BITP_ROM_WUA_CHKHDR 24
28 #define BITP_ROM_WUA_DDRLOCK 7
29 #define BITP_ROM_WUA_DDRDLLEN 6
30 #define BITP_ROM_WUA_DDR 5
31 #define BITP_ROM_WUA_CGU 4
32 #define BITP_ROM_WUA_MEMBOOT 2
33 #define BITP_ROM_WUA_EN 1
35 #define BITM_ROM_WUA_CHKHDR (0xFF000000)
36 #define ENUM_ROM_WUA_CHKHDR_AD 0xAD000000
38 #define BITM_ROM_WUA_DDRLOCK (0x00000080)
39 #define BITM_ROM_WUA_DDRDLLEN (0x00000040)
40 #define BITM_ROM_WUA_DDR (0x00000020)
41 #define BITM_ROM_WUA_CGU (0x00000010)
42 #define BITM_ROM_WUA_MEMBOOT (0x00000002)
43 #define BITM_ROM_WUA_EN (0x00000001)
45 /***********************************************************/
49 /***********************************************************/
50 #define BITP_ROM_SYSCTRL_CGU_LOCKINGEN 28 /* unlocks CGU_CTL register */
51 #define BITP_ROM_SYSCTRL_WUA_OVERRIDE 24
52 #define BITP_ROM_SYSCTRL_WUA_DDRDLLEN 20 /* Saves the DDR DLL and PADS registers to the DPM registers */
53 #define BITP_ROM_SYSCTRL_WUA_DDR 19 /* Saves the DDR registers to the DPM registers */
54 #define BITP_ROM_SYSCTRL_WUA_CGU 18 /* Saves the CGU registers into DPM registers */
55 #define BITP_ROM_SYSCTRL_WUA_DPMWRITE 17 /* Saves the Syscontrol structure structure contents into DPM registers */
56 #define BITP_ROM_SYSCTRL_WUA_EN 16 /* reads current PLL and DDR configuration into structure */
57 #define BITP_ROM_SYSCTRL_DDR_WRITE 13 /* writes the DDR registers from Syscontrol structure for wakeup initialization of DDR */
58 #define BITP_ROM_SYSCTRL_DDR_READ 12 /* Read the DDR registers into the Syscontrol structure for storing prior to hibernate */
59 #define BITP_ROM_SYSCTRL_CGU_AUTODIS 11 /* Disables auto handling of UPDT and ALGN fields */
60 #define BITP_ROM_SYSCTRL_CGU_CLKOUTSEL 7 /* access CGU_CLKOUTSEL register */
61 #define BITP_ROM_SYSCTRL_CGU_DIV 6 /* access CGU_DIV register */
62 #define BITP_ROM_SYSCTRL_CGU_STAT 5 /* access CGU_STAT register */
63 #define BITP_ROM_SYSCTRL_CGU_CTL 4 /* access CGU_CTL register */
64 #define BITP_ROM_SYSCTRL_CGU_RTNSTAT 2 /* Update structure STAT field upon error */
65 #define BITP_ROM_SYSCTRL_WRITE 1 /* write registers */
66 #define BITP_ROM_SYSCTRL_READ 0 /* read registers */
68 #define BITM_ROM_SYSCTRL_CGU_READ (0x00000001) /* Read CGU registers */
69 #define BITM_ROM_SYSCTRL_CGU_WRITE (0x00000002) /* Write registers */
70 #define BITM_ROM_SYSCTRL_CGU_RTNSTAT (0x00000004) /* Update structure STAT field upon error or after a write operation */
71 #define BITM_ROM_SYSCTRL_CGU_CTL (0x00000010) /* Access CGU_CTL register */
72 #define BITM_ROM_SYSCTRL_CGU_STAT (0x00000020) /* Access CGU_STAT register */
73 #define BITM_ROM_SYSCTRL_CGU_DIV (0x00000040) /* Access CGU_DIV register */
74 #define BITM_ROM_SYSCTRL_CGU_CLKOUTSEL (0x00000080) /* Access CGU_CLKOUTSEL register */
75 #define BITM_ROM_SYSCTRL_CGU_AUTODIS (0x00000800) /* Disables auto handling of UPDT and ALGN fields */
76 #define BITM_ROM_SYSCTRL_DDR_READ (0x00001000) /* Reads the contents of the DDR registers and stores them into the structure */
77 #define BITM_ROM_SYSCTRL_DDR_WRITE (0x00002000) /* Writes the DDR registers from the structure, only really intented for wakeup functionality and not for full DDR configuration */
78 #define BITM_ROM_SYSCTRL_WUA_EN (0x00010000) /* Wakeup entry or exit opertation enable */
79 #define BITM_ROM_SYSCTRL_WUA_DPMWRITE (0x00020000) /* When set indicates a restore of the PLL and DDR is to be performed otherwise a save is required */
80 #define BITM_ROM_SYSCTRL_WUA_CGU (0x00040000) /* Only applicable for a PLL and DDR save operation to the DPM, saves the current settings if cleared or the contents of the structure if set */
81 #define BITM_ROM_SYSCTRL_WUA_DDR (0x00080000) /* Only applicable for a PLL and DDR save operation to the DPM, saves the current settings if cleared or the contents of the structure if set */
82 #define BITM_ROM_SYSCTRL_WUA_DDRDLLEN (0x00100000) /* Enables saving/restoring of the DDR DLLCTL register */
83 #define BITM_ROM_SYSCTRL_WUA_OVERRIDE (0x01000000)
84 #define BITM_ROM_SYSCTRL_CGU_LOCKINGEN (0x10000000) /* Unlocks the CGU_CTL register */
87 /* Structures for the syscontrol() function */
88 struct STRUCT_ROM_SYSCTRL
{
92 uint32_t ulCGU_CLKOUTSEL
;
94 uint32_t ulWUA_BootAddr
;
104 uint32_t ulDDR_PADCTL
;
105 uint32_t ulDDR_DLLCTL
;
109 struct bfin_pm_data
{
111 uint32_t resume_addr
;
115 struct bfin_pm_data bf609_pm_data
;
117 struct STRUCT_ROM_SYSCTRL configvalues
;
118 uint32_t dactionflags
;
120 #define FUNC_ROM_SYSCONTROL 0xC8000080
121 __attribute__((l1_data
))
122 static uint32_t (* const bfrom_SysControl
)(uint32_t action_flags
, struct STRUCT_ROM_SYSCTRL
*settings
, void *reserved
) = (void *)FUNC_ROM_SYSCONTROL
;
124 __attribute__((l1_text
))
125 void bfin_cpu_suspend(void)
127 __asm__
__volatile__( \
134 __attribute__((l1_text
))
135 void bfin_deepsleep(unsigned long mask
)
139 bfin_write32(DPM0_WAKE_EN
, 0x10);
140 bfin_write32(DPM0_WAKE_POL
, 0x10);
141 dpm0_ctl
= bfin_read32(DPM0_CTL
);
142 dpm0_ctl
= 0x00000008;
143 bfin_write32(DPM0_CTL
, dpm0_ctl
);
145 __asm__
__volatile__( \
152 __attribute__((l1_text
))
153 void bf609_ddr_sr(void)
157 reg
= bfin_read_DDR0_CTL();
159 bfin_write_DDR0_CTL(reg
);
161 while (!(bfin_read_DDR0_STAT() & 0x8))
165 __attribute__((l1_text
))
166 void bf609_ddr_sr_exit(void)
169 while (!(bfin_read_DDR0_STAT() & 0x1))
172 reg
= bfin_read_DDR0_CTL();
174 bfin_write_DDR0_CTL(reg
);
176 while ((bfin_read_DDR0_STAT() & 0x8))
180 __attribute__((l1_text
))
181 void bfin_hibernate_syscontrol(void)
183 configvalues
.ulWUA_Flags
= (0xAD000000 | BITM_ROM_WUA_EN
184 | BITM_ROM_WUA_CGU
| BITM_ROM_WUA_DDR
| BITM_ROM_WUA_DDRDLLEN
);
186 dactionflags
= (BITM_ROM_SYSCTRL_WUA_EN
187 | BITM_ROM_SYSCTRL_WUA_DPMWRITE
| BITM_ROM_SYSCTRL_WUA_CGU
188 | BITM_ROM_SYSCTRL_WUA_DDR
| BITM_ROM_SYSCTRL_WUA_DDRDLLEN
);
190 bfrom_SysControl(dactionflags
, &configvalues
, NULL
);
192 bfin_write32(DPM0_RESTORE5
, bfin_read32(DPM0_RESTORE5
) | 4);
196 # define SIC_SYSIRQ(irq) (irq - (IRQ_CORETMR + 1))
198 # define SIC_SYSIRQ(irq) ((irq) - IVG15)
200 void bfin_hibernate(unsigned long mask
)
202 bfin_write32(DPM0_WAKE_EN
, 0x10);
203 bfin_write32(DPM0_WAKE_POL
, 0x10);
204 bfin_write32(DPM0_PGCNTR
, 0x0000FFFF);
205 bfin_write32(DPM0_HIB_DIS
, 0xFFFF);
207 printk(KERN_DEBUG
"hibernate: restore %x pgcnt %x\n", bfin_read32(DPM0_RESTORE0
), bfin_read32(DPM0_PGCNTR
));
212 void bf609_cpu_pm_enter(suspend_state_t state
)
215 unsigned long wakeup
= 0;
216 unsigned long wakeup_pol
= 0;
218 #ifdef CONFIG_PM_BFIN_WAKE_PA15
220 # if CONFIG_PM_BFIN_WAKE_PA15_POL
221 wakeup_pol
|= PA15WE
;
225 #ifdef CONFIG_PM_BFIN_WAKE_PB15
227 # if CONFIG_PM_BFIN_WAKE_PA15_POL
228 wakeup_pol
|= PB15WE
;
232 #ifdef CONFIG_PM_BFIN_WAKE_PC15
234 # if CONFIG_PM_BFIN_WAKE_PC15_POL
235 wakeup_pol
|= PC15WE
;
239 #ifdef CONFIG_PM_BFIN_WAKE_PD06
241 # if CONFIG_PM_BFIN_WAKE_PD06_POL
242 wakeup_pol
|= PD06WE
;
246 #ifdef CONFIG_PM_BFIN_WAKE_PE12
248 # if CONFIG_PM_BFIN_WAKE_PE12_POL
249 wakeup_pol
|= PE12WE
;
253 #ifdef CONFIG_PM_BFIN_WAKE_PG04
255 # if CONFIG_PM_BFIN_WAKE_PG04_POL
256 wakeup_pol
|= PG04WE
;
260 #ifdef CONFIG_PM_BFIN_WAKE_PG13
262 # if CONFIG_PM_BFIN_WAKE_PG13_POL
263 wakeup_pol
|= PG13WE
;
267 #ifdef CONFIG_PM_BFIN_WAKE_USB
269 # if CONFIG_PM_BFIN_WAKE_USB_POL
274 error
= irq_set_irq_wake(255, 1);
276 printk(KERN_DEBUG
"Unable to get irq wake\n");
277 error
= irq_set_irq_wake(231, 1);
279 printk(KERN_DEBUG
"Unable to get irq wake\n");
281 if (state
== PM_SUSPEND_STANDBY
)
282 bfin_deepsleep(wakeup
);
284 bfin_hibernate(wakeup
);
288 int bf609_cpu_pm_prepare(void)
293 void bf609_cpu_pm_finish(void)
298 static struct bfin_cpu_pm_fns bf609_cpu_pm
= {
299 .enter
= bf609_cpu_pm_enter
,
300 .prepare
= bf609_cpu_pm_prepare
,
301 .finish
= bf609_cpu_pm_finish
,
304 static irqreturn_t
test_isr(int irq
, void *dev_id
)
306 printk(KERN_DEBUG
"gpio irq %d\n", irq
);
310 static irqreturn_t
dpm0_isr(int irq
, void *dev_id
)
314 wake_stat
= bfin_read32(DPM0_WAKE_STAT
);
315 printk(KERN_DEBUG
"enter %s wake stat %08x\n", __func__
, wake_stat
);
317 bfin_write32(DPM0_WAKE_STAT
, wake_stat
);
321 static int __init
bf609_init_pm(void)
326 #if CONFIG_PM_BFIN_WAKE_PE12
327 irq
= gpio_to_irq(GPIO_PE12
);
330 printk(KERN_DEBUG
"Unable to get irq number for GPIO %d, error %d\n",
334 error
= request_irq(irq
, test_isr
, IRQF_TRIGGER_RISING
| IRQF_NO_SUSPEND
, "gpiope12", NULL
);
336 printk(KERN_DEBUG
"Unable to get irq\n");
339 error
= request_irq(IRQ_CGU_EVT
, dpm0_isr
, IRQF_NO_SUSPEND
, "cgu0 event", NULL
);
341 printk(KERN_DEBUG
"Unable to get irq\n");
343 error
= request_irq(IRQ_DPM
, dpm0_isr
, IRQF_NO_SUSPEND
, "dpm0 event", NULL
);
345 printk(KERN_DEBUG
"Unable to get irq\n");
347 bfin_cpu_pm
= &bf609_cpu_pm
;
351 late_initcall(bf609_init_pm
);