arch/arm/mach-omap2/clockdomain44xx.c

   1 /*
   2  * OMAP4 clockdomain control
   3  *
   4  * Copyright (C) 2008-2010 Texas Instruments, Inc.
   5  * Copyright (C) 2008-2010 Nokia Corporation
   6  *
   7  * Derived from mach-omap2/clockdomain.c written by Paul Walmsley
   8  * Rajendra Nayak <rnayak@ti.com>
   9  *
  10  * This program is free software; you can redistribute it and/or modify
  11  * it under the terms of the GNU General Public License version 2 as
  12  * published by the Free Software Foundation.
  13  */
  14
  15 #include <linux/kernel.h>
  16 #include "clockdomain.h"
  17 #include "cminst44xx.h"
  18 #include "cm44xx.h"
  19
  20 static int omap4_clkdm_add_wkup_sleep_dep(struct clockdomain *clkdm1,
  21                                         struct clockdomain *clkdm2)
  22 {
  23         omap4_cminst_set_inst_reg_bits((1 << clkdm2->dep_bit),
  24                                         clkdm1->prcm_partition,
  25                                         clkdm1->cm_inst, clkdm1->clkdm_offs +
  26                                         OMAP4_CM_STATICDEP);
  27         return 0;
  28 }
  29
  30 static int omap4_clkdm_del_wkup_sleep_dep(struct clockdomain *clkdm1,
  31                                         struct clockdomain *clkdm2)
  32 {
  33         omap4_cminst_clear_inst_reg_bits((1 << clkdm2->dep_bit),
  34                                         clkdm1->prcm_partition,
  35                                         clkdm1->cm_inst, clkdm1->clkdm_offs +
  36                                         OMAP4_CM_STATICDEP);
  37         return 0;
  38 }
  39
  40 static int omap4_clkdm_read_wkup_sleep_dep(struct clockdomain *clkdm1,
  41                                         struct clockdomain *clkdm2)
  42 {
  43         return omap4_cminst_read_inst_reg_bits(clkdm1->prcm_partition,
  44                                         clkdm1->cm_inst, clkdm1->clkdm_offs +
  45                                         OMAP4_CM_STATICDEP,
  46                                         (1 << clkdm2->dep_bit));
  47 }
  48
  49 static int omap4_clkdm_clear_all_wkup_sleep_deps(struct clockdomain *clkdm)
  50 {
  51         struct clkdm_dep *cd;
  52         u32 mask = 0;
  53
  54         for (cd = clkdm->wkdep_srcs; cd && cd->clkdm_name; cd++) {
  55                 if (!omap_chip_is(cd->omap_chip))
  56                         continue;
  57                 if (!cd->clkdm)
  58                         continue; /* only happens if data is erroneous */
  59
  60                 mask |= 1 << cd->clkdm->dep_bit;
  61                 atomic_set(&cd->wkdep_usecount, 0);
  62         }
  63
  64         omap4_cminst_clear_inst_reg_bits(mask, clkdm->prcm_partition,
  65                                         clkdm->cm_inst, clkdm->clkdm_offs +
  66                                         OMAP4_CM_STATICDEP);
  67         return 0;
  68 }
  69
  70 static int omap4_clkdm_sleep(struct clockdomain *clkdm)
  71 {
  72         omap4_cminst_clkdm_force_sleep(clkdm->prcm_partition,
  73                                         clkdm->cm_inst, clkdm->clkdm_offs);
  74         return 0;
  75 }
  76
  77 static int omap4_clkdm_wakeup(struct clockdomain *clkdm)
  78 {
  79         omap4_cminst_clkdm_force_wakeup(clkdm->prcm_partition,
  80                                         clkdm->cm_inst, clkdm->clkdm_offs);
  81         return 0;
  82 }
  83
  84 static void omap4_clkdm_allow_idle(struct clockdomain *clkdm)
  85 {
  86         omap4_cminst_clkdm_enable_hwsup(clkdm->prcm_partition,
  87                                         clkdm->cm_inst, clkdm->clkdm_offs);
  88 }
  89
  90 static void omap4_clkdm_deny_idle(struct clockdomain *clkdm)
  91 {
  92         omap4_cminst_clkdm_disable_hwsup(clkdm->prcm_partition,
  93                                         clkdm->cm_inst, clkdm->clkdm_offs);
  94 }
  95
  96 static int omap4_clkdm_is_idle(struct clockdomain *clkdm)
  97 {
  98         return omap4_cminst_is_clkdm_in_hwsup(clkdm->prcm_partition,
  99                                 clkdm->cm_inst, clkdm->clkdm_offs);
 100 }
 101
 102 static int omap4_clkdm_clk_enable(struct clockdomain *clkdm)
 103 {
 104         /* For every clock enable, force wakeup the clkdm */
 105         clkdm_wakeup(clkdm);
 106
 107         return 0;
 108 }
 109
 110 static int omap4_clkdm_clk_disable(struct clockdomain *clkdm)
 111 {
 112         bool hwsup = false;
 113
 114         hwsup = omap4_cminst_is_clkdm_in_hwsup(clkdm->prcm_partition,
 115                                         clkdm->cm_inst, clkdm->clkdm_offs);
 116
 117         if (!hwsup)
 118                 clkdm_sleep(clkdm);
 119
 120         return 0;
 121 }
 122
 123 struct clkdm_ops omap4_clkdm_operations = {
 124         .clkdm_add_wkdep        = omap4_clkdm_add_wkup_sleep_dep,
 125         .clkdm_del_wkdep        = omap4_clkdm_del_wkup_sleep_dep,
 126         .clkdm_read_wkdep       = omap4_clkdm_read_wkup_sleep_dep,
 127         .clkdm_clear_all_wkdeps = omap4_clkdm_clear_all_wkup_sleep_deps,
 128         .clkdm_add_sleepdep     = omap4_clkdm_add_wkup_sleep_dep,
 129         .clkdm_del_sleepdep     = omap4_clkdm_del_wkup_sleep_dep,
 130         .clkdm_read_sleepdep    = omap4_clkdm_read_wkup_sleep_dep,
 131         .clkdm_clear_all_sleepdeps      = omap4_clkdm_clear_all_wkup_sleep_deps,
 132         .clkdm_sleep            = omap4_clkdm_sleep,
 133         .clkdm_wakeup           = omap4_clkdm_wakeup,
 134         .clkdm_allow_idle       = omap4_clkdm_allow_idle,
 135         .clkdm_deny_idle        = omap4_clkdm_deny_idle,
 136         .clkdm_is_idle          = omap4_clkdm_is_idle,
 137         .clkdm_clk_enable       = omap4_clkdm_clk_enable,
 138         .clkdm_clk_disable      = omap4_clkdm_clk_disable,
 139 };