1 #include <linux/kernel.h>
2 #include <linux/init.h>
3 #include <linux/suspend.h>
4 #include <asm/cacheflush.h>
5 #include <asm/tlbflush.h>
6 #include <asm/suspend.h>
7 #include <linux/delay.h>
8 #include <linux/moduleparam.h>
9 #include <linux/rockchip/common.h>
15 /*************************dump reg********************************************/
17 void rkpm_ddr_reg_offset_dump(void __iomem * base_addr,u32 _offset)
19 rkpm_ddr_printhex(_offset);
20 rkpm_ddr_printch('-');
21 rkpm_ddr_printhex(readl_relaxed((base_addr + _offset)));
24 void rkpm_ddr_regs_dump(void __iomem * base_addr,u32 start_offset,u32 end_offset)
29 rkpm_ddr_printascii("start from:");
30 rkpm_ddr_printhex((u32)(base_addr +start_offset));
31 rkpm_ddr_printch('\n');
34 for(i=start_offset;i<=end_offset;)
37 rkpm_ddr_printhex(reg_readl((base_addr + i)));
40 rkpm_ddr_printch('\n');
45 rkpm_ddr_printch('-');
47 rkpm_ddr_printch('\n');
55 static struct rkpm_ops pm_ops={NULL};
57 static struct rkpm_sram_ops *p_pm_sram_ops=NULL;//pie point for pm_sram_ops
58 static rkpm_sram_suspend_arg_cb p_suspend_pie_cb=NULL;
61 static u32 rkpm_ctrbits=0;
62 //for judging rkpm_ctrbits valid ,save ifself
63 static u32 rkpm_jdg_ctrbits=0;
64 static u32 rkpm_jdg_sram_ctrbits=0;
66 /**************************************ddr callback setting***************************************/
68 void rkpm_set_pie_info(struct rkpm_sram_ops *pm_sram_ops,rkpm_sram_suspend_arg_cb pie_cb)
71 p_pm_sram_ops=pm_sram_ops;
72 p_suspend_pie_cb=pie_cb;
77 void rkpm_set_ops_prepare_finish(rkpm_ops_void_callback prepare,rkpm_ops_void_callback finish)
79 pm_ops.prepare=prepare;
83 void rkpm_set_ops_pwr_dmns(rkpm_ops_void_callback pwr_dmns,rkpm_ops_void_callback re_pwr_dmns)
85 pm_ops.pwr_dmns=pwr_dmns;
86 pm_ops.re_pwr_dmns=re_pwr_dmns;
89 void rkpm_set_ops_gtclks(rkpm_ops_void_callback gtclks,rkpm_ops_void_callback re_gtclks)
92 pm_ops.re_gtclks=re_gtclks;
96 void rkpm_set_ops_plls(rkpm_ops_void_callback plls,rkpm_ops_void_callback re_plls)
99 pm_ops.re_plls=re_plls;
103 void rkpm_set_ops_gpios(rkpm_ops_void_callback gpios,rkpm_ops_void_callback re_gpios)
106 pm_ops.re_gpios=re_gpios;
108 void rkpm_set_ops_save_setting(rkpm_ops_paramter_u32_cb save_setting,rkpm_ops_void_callback re_save_setting)
110 pm_ops.save_setting=save_setting;
111 pm_ops.re_save_setting=re_save_setting;
116 void rkpm_set_ops_printch(rkpm_ops_printch_callback printch)
118 pm_ops.printch=printch;
121 void rkpm_set_ops_regs_pread(rkpm_ops_void_callback regs_pread)
123 pm_ops.regs_pread=regs_pread;
126 void rkpm_set_ops_regs_sleep(rkpm_ops_void_callback slp_setting,rkpm_ops_void_callback re_last)
129 pm_ops.slp_setting=slp_setting;
131 pm_ops.slp_re_first=re_last;
135 /**************************************sram callback setting***************************************/
136 void rkpm_set_sram_ops_volt(rkpm_ops_void_callback volts,rkpm_ops_void_callback re_volts)
140 p_pm_sram_ops->volts=volts;
141 p_pm_sram_ops->re_volts=re_volts;
145 void rkpm_set_sram_ops_gtclks(rkpm_ops_void_callback gtclks,rkpm_ops_void_callback re_gtclks)
149 p_pm_sram_ops->gtclks=gtclks;
150 p_pm_sram_ops->re_gtclks=re_gtclks;
154 void rkpm_set_sram_ops_sysclk(rkpm_ops_paramter_u32_cb sysclk,rkpm_ops_paramter_u32_cb re_sysclk)
158 p_pm_sram_ops->sysclk=sysclk;
159 p_pm_sram_ops->re_sysclk=re_sysclk;
163 void rkpm_set_sram_ops_pmic(rkpm_ops_void_callback pmic,rkpm_ops_void_callback re_pmic)
167 p_pm_sram_ops->pmic=pmic;
168 p_pm_sram_ops->re_pmic=re_pmic;
172 void rkpm_set_sram_ops_ddr(rkpm_ops_void_callback ddr,rkpm_ops_void_callback re_ddr)
176 p_pm_sram_ops->ddr=ddr;
177 p_pm_sram_ops->re_ddr=re_ddr;
181 void rkpm_set_sram_ops_bus(rkpm_ops_void_callback bus_idle_request)
184 p_pm_sram_ops->bus_idle_request = bus_idle_request;
186 void rkpm_set_sram_ops_printch(rkpm_ops_printch_callback printch)
189 p_pm_sram_ops->printch=printch;
192 /******************for user ************************/
193 void rkpm_set_ctrbits(u32 bits)
198 void rkpm_add_ctrbits(u32 bits)
200 rkpm_ctrbits |= bits;
203 u32 rkpm_get_ctrbits(void)
208 u32 rkpm_chk_ctrbits(u32 bits)
210 return (rkpm_ctrbits&bits);
214 void rkpm_clr_ctrbits(u32 bits)
219 /****************** for pm.c************************/
221 static void inline rkpm_set_jdg_ctrbits(u32 bits)
223 rkpm_jdg_ctrbits = bits;
226 static u32 inline rkpm_get_jdg_ctrbits(void)
228 return rkpm_jdg_ctrbits;
231 static void inline rkpm_add_jdg_ctrbits(int bit)
233 rkpm_jdg_ctrbits|=bit;
237 static u32 inline rkpm_chk_jdg_ctrbit(int bit)
239 return (rkpm_jdg_ctrbits&bit);
243 static u32 inline rkpm_chk_jdg_ctrbits(int bits)
245 return (rkpm_jdg_ctrbits&bits);
248 static void inline rkpm_clr_jdg_ctrbits(int bit)
250 rkpm_jdg_ctrbits&=~bit;
254 #define RKPM_DDR_FUN(fun) \
258 // fun with paramater param (p1,p2,p3)
259 #define RKPM_DDR_PFUN(fun,param) \
261 {(pm_ops.fun)param;} while(0)
263 #define RKPM_BITCTR_DDR_FUN(ctr,fun) \
264 if(rkpm_chk_jdg_ctrbits(RKPM_CTR_##ctr)&&pm_ops.fun)\
267 #define RKPM_BITSCTR_DDR_FUN(bits,fun) \
268 if(rkpm_chk_jdg_ctrbits(bits)&&pm_ops.fun)\
273 #define RKPM_LPMD_BITSCTR_DDR_PFUN(bits,fun,param) \
274 if(rkpm_chk_jdg_ctrbits(RKPM_CTRBITS_SOC_DLPMD)&&pm_ops.fun)\
277 #define RKPM_LPMD_BITSCTR_DDR_FUN(bits,fun) \
278 if(rkpm_chk_jdg_ctrbits(RKPM_CTRBITS_SOC_DLPMD)&&pm_ops.fun)\
283 void rkpm_ctrbits_prepare(void)
286 //rkpm_sram_ctrbits=rkpm_ctrbits;
288 rkpm_jdg_ctrbits=rkpm_ctrbits;
290 //if plls is no pd,clk rate is high, volts can not setting low,so we need to judge ctrbits
291 //if(rkpm_chk_jdg_ctrbits(RKPM_CTR_VOLTS))
293 //rkpm_clr_jdg_ctrbits(RKPM_CTR_VOLTS);
296 rkpm_jdg_sram_ctrbits=rkpm_jdg_ctrbits;
298 //clk gating will gate ddr clk in sram
299 if(!rkpm_chk_val_ctrbits(rkpm_jdg_sram_ctrbits,RKPM_CTR_DDR))
301 // rkpm_clr_val_ctrbit(rkpm_jdg_sram_ctrbits,RKPM_CTR_GTCLKS);
306 struct rk_soc_pm_info_st {
311 #define RK_SOC_PM_HELP_(id,NAME)\
313 .offset= RKPM_CTR_##id,\
317 struct rk_soc_pm_info_st rk_soc_pm_helps[]={
319 RK_SOC_PM_HELP_(NO_PD,"pd is not power dn"),
320 RK_SOC_PM_HELP_(NO_CLK_GATING,"clk is not gating"),
321 RK_SOC_PM_HELP_(NO_PLL,"pll is not power dn"),
322 RK_SOC_PM_HELP_(NO_VOLT,"volt is not set suspend"),
323 RK_SOC_PM_HELP_(NO_GPIO,"gpio is not control "),
324 //RK_SOC_PM_HELP_(NO_SRAM,"not enter sram code"),
325 RK_SOC_PM_HELP_(NO_DDR,"ddr is not reflash"),
326 RK_SOC_PM_HELP_(NO_PMIC,"pmic is not suspend"),
327 RK_SOC_PM_HELP_(RET_DIRT,"sys return from pm_enter directly"),
328 RK_SOC_PM_HELP_(SRAM_NO_WFI,"sys is not runing wfi in sram"),
329 RK_SOC_PM_HELP_(WAKE_UP_KEY,"send a power key to wake up lcd"),
333 ssize_t rk_soc_pm_helps_sprintf(char *buf)
338 for(i=0;i<ARRAY_SIZE(rk_soc_pm_helps);i++)
340 s += sprintf(s, "bit(%d): %s\n", rk_soc_pm_helps[i].offset,rk_soc_pm_helps[i].name);
346 void rk_soc_pm_helps_printk(void)
349 printk("**************rkpm_ctr_bits bits help***********:\n");
350 for(i=0;i<ARRAY_SIZE(rk_soc_pm_helps);i++)
352 printk("bit(%d): %s\n", rk_soc_pm_helps[i].offset,rk_soc_pm_helps[i].name);
357 static int __init early_param_rk_soc_pm_ctr(char *str)
359 get_option(&str, &rkpm_ctrbits);
361 printk("********rkpm_ctr_bits information is following:*********\n");
362 printk("rkpm_ctr_bits=%x\n",rkpm_ctrbits);
365 rk_soc_pm_helps_printk();
367 printk("********rkpm_ctr_bits information end*********\n");
372 /*******************************************log*********************************************/
377 extern void pm_emit_log_char(char c);
379 /********************************ddr print**********************************/
380 void rkpm_ddr_printch(char byte)
383 pm_ops.printch(byte);
385 //rkpm_ddr_printch('\r');
387 void rkpm_ddr_printascii(const char *s)
390 rkpm_ddr_printch(*s);
395 void rkpm_ddr_printhex(unsigned int hex)
398 rkpm_ddr_printch('0');
399 rkpm_ddr_printch('x');
401 unsigned char c = (hex & 0xF0000000) >> 28;
402 rkpm_ddr_printch(c < 0xa ? c + '0' : c - 0xa + 'a');
406 void rk_sram_suspend(void)
408 RKPM_DDR_FUN(regs_pread);
409 rkpm_ddr_printascii("sram");
410 call_with_stack(p_suspend_pie_cb
411 , &rkpm_jdg_sram_ctrbits, rockchip_sram_stack);
413 static int rk_lpmode_enter(unsigned long arg)
416 //RKPM_DDR_PFUN(slp_setting(rkpm_jdg_sram_ctrbits),slp_setting);
418 RKPM_DDR_FUN(slp_setting);
420 local_flush_tlb_all();
425 //outer_inv_all();// ???
426 // l2x0_inv_all_pm(); //rk319x is not need
429 rkpm_ddr_printch('d');
436 rkpm_ddr_printch('D');
440 int cpu_suspend(unsigned long arg, int (*fn)(unsigned long));
441 static int rkpm_enter(suspend_state_t state)
443 //static u32 test_count=0;
444 // printk(KERN_DEBUG"pm: ");
445 printk("%s:\n",__FUNCTION__);
446 //printk("pm test times=%d\n",++test_count);
448 RKPM_DDR_FUN(prepare);
450 rkpm_ctrbits_prepare();
452 // if(rkpm_chk_jdg_ctrbits(RKPM_CTR_RET_DIRT))
455 rkpm_ddr_printch('0');
457 RKPM_BITCTR_DDR_FUN(PWR_DMNS,pwr_dmns);
459 rkpm_ddr_printch('1');
463 RKPM_DDR_PFUN(save_setting,(rkpm_jdg_sram_ctrbits));
465 rkpm_ddr_printch('2');
467 RKPM_BITCTR_DDR_FUN(GTCLKS,gtclks);
469 rkpm_ddr_printch('3');
471 RKPM_BITCTR_DDR_FUN(PLLS,plls);
473 rkpm_ddr_printch('4');
475 RKPM_BITCTR_DDR_FUN(GPIOS,gpios);
477 RKPM_DDR_FUN(regs_pread);
479 rkpm_ddr_printch('5');
481 if(rkpm_chk_jdg_ctrbits(RKPM_CTRBITS_SOC_DLPMD))
483 if(cpu_suspend(0,rk_lpmode_enter)==0)
485 RKPM_DDR_FUN(slp_re_first);
486 rkpm_ddr_printch('K');
487 //rk_soc_pm_ctr_bits_prepare();
489 rkpm_ddr_printch('d');
491 else if(rkpm_chk_jdg_ctrbits(RKPM_CTR_IDLESRAM_MD)&&p_suspend_pie_cb)
493 call_with_stack(p_suspend_pie_cb,&rkpm_jdg_sram_ctrbits, rockchip_sram_stack);
501 rkpm_ddr_printch('5');
503 RKPM_BITCTR_DDR_FUN(GPIOS,re_gpios);
505 rkpm_ddr_printch('4');
507 RKPM_BITCTR_DDR_FUN(PLLS,re_plls);
509 rkpm_ddr_printch('3');
511 RKPM_BITCTR_DDR_FUN(GTCLKS,re_gtclks);
513 rkpm_ddr_printch('2');
515 RKPM_DDR_FUN(re_save_setting);
518 rkpm_ddr_printch('1');
520 RKPM_BITCTR_DDR_FUN(PWR_DMNS,re_pwr_dmns);
522 rkpm_ddr_printch('0');
523 rkpm_ddr_printch('\n');
525 RKPM_DDR_FUN(finish);
530 static int rkpm_enter_tst(void)
533 return rkpm_enter(0);
538 static int rkpm_suspend_prepare(void)
540 /* disable entering idle by disable_hlt() */
545 static void rkpm_suspend_finish(void)
549 #if 0 //def CONFIG_KEYS_RK29
550 if(rkpm_check_ctrbits(1<<RKPM_CTR_WAKE_UP_KEY))
552 rk28_send_wakeup_key();
553 printk("rk30_pm_finish rk28_send_wakeup_key\n");
559 static struct platform_suspend_ops rockchip_suspend_ops = {
561 .valid = suspend_valid_only_mem,
562 .prepare = rkpm_suspend_prepare,
563 .finish = rkpm_suspend_finish,
565 void __init rockchip_suspend_init(void)
567 //printk("%s\n",__FUNCTION__);
568 suspend_set_ops(&rockchip_suspend_ops);
571 #endif /* CONFIG_ARM */
573 static enum rockchip_pm_policy pm_policy;
574 static BLOCKING_NOTIFIER_HEAD(policy_notifier_list);
576 int rockchip_pm_policy_register_notifier(struct notifier_block *nb)
578 return blocking_notifier_chain_register(&policy_notifier_list, nb);
581 int rockchip_pm_policy_unregister_notifier(struct notifier_block *nb)
583 return blocking_notifier_chain_unregister(&policy_notifier_list, nb);
586 static int rockchip_pm_policy_notify(void)
588 return blocking_notifier_call_chain(&policy_notifier_list,
592 enum rockchip_pm_policy rockchip_pm_get_policy(void)
597 int rockchip_pm_set_policy(enum rockchip_pm_policy policy)
599 if (policy < ROCKCHIP_PM_NR_POLICYS && policy != pm_policy) {
600 printk(KERN_INFO "pm policy %d -> %d\n", pm_policy, policy);
602 rockchip_pm_policy_notify();
608 static unsigned int policy;
610 static int set_policy(const char *val, const struct kernel_param *kp)
614 ret = param_set_uint(val, kp);
618 rockchip_pm_set_policy(policy);
619 policy = rockchip_pm_get_policy();
624 static struct kernel_param_ops policy_param_ops = {
626 .get = param_get_uint,
629 module_param_cb(policy, &policy_param_ops, &policy, 0600);