Adds init/change_level/validate_level calls for OMAP3 resources

Signed-off-by: Rajendra Nayak <[EMAIL PROTECTED]>
---
 arch/arm/mach-omap2/resource34xx.c |  148 +++++++++++++++++++++++++++++++++++++
 1 files changed, 148 insertions(+)

Index: linux-omap-2.6/arch/arm/mach-omap2/resource34xx.c
===================================================================
--- /dev/null   1970-01-01 00:00:00.000000000 +0000
+++ linux-omap-2.6/arch/arm/mach-omap2/resource34xx.c   2008-08-07
15:07:04.000000000 +0530
@@ -0,0 +1,148 @@
+/*
+ * linux/arch/arm/mach-omap2/resource34xx.c
+ * OMAP3 resource init/change_level/validate_level functions
+ *
+ * Copyright (C) 2007-2008 Texas Instruments, Inc.
+ * Written by Rajendra Nayak <[EMAIL PROTECTED]>
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 as
+ * published by the Free Software Foundation.
+ *
+ * THIS PACKAGE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR
+ * IMPLIED WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED
+ * WARRANTIES OF MERCHANTIBILITY AND FITNESS FOR A PARTICULAR PURPOSE.
+ * History:
+ *
+ */
+
+#include <linux/pm_qos_params.h>
+#include <asm/arch/powerdomain.h>
+#include <asm/arch/clockdomain.h>
+#include "resource34xx.h"
+
+/**
+ * init_latency - Initializes the mpu/core latency resource.
+ * @resp: Latency resource to be initalized
+ *
+ * No return value.
+ */
+void init_latency(struct shared_resource *resp)
+{
+       resp->no_of_users = 0;
+       resp->curr_level = RES_DEFAULTLEVEL;
+       *((u8 *)resp->resource_data) = 0;
+       return;
+}
+
+/**
+ * set_latency - Adds/Updates and removes the CPU_DMA_LATENCY in 
*pm_qos_params.
+ * @resp: resource pointer
+ * @latency: target latency to be set
+ *
+ * Returns 0 on success, or error values as returned by
+ * pm_qos_update_requirement/pm_qos_add_requirement.
+ */
+int set_latency(struct shared_resource *resp, u32 latency)
+{
+       u8 *pm_qos_req_added;
+
+       if (resp->curr_level == latency)
+               return 0;
+       else
+               /* Update the resources current level */
+               resp->curr_level = latency;
+
+       pm_qos_req_added = resp->resource_data;
+       if (latency == RES_DEFAULTLEVEL)
+               /* No more users left, remove the pm_qos_req if present */
+               if (*pm_qos_req_added) {
+                       pm_qos_remove_requirement(PM_QOS_CPU_DMA_LATENCY,
+                                                       resp->name);
+                       *pm_qos_req_added = 0;
+                       return 0;
+               }
+
+       if (*pm_qos_req_added) {
+               return pm_qos_update_requirement(PM_QOS_CPU_DMA_LATENCY,
+                                               resp->name, latency);
+       } else {
+               *pm_qos_req_added = 1;
+               return pm_qos_add_requirement(PM_QOS_CPU_DMA_LATENCY,
+                                               resp->name, latency);
+       }
+}
+
+/**
+ * init_pd_latency - Initializes the power domain latency resource.
+ * @resp: Power Domain Latency resource to be initialized.
+ *
+ * No return value.
+ */
+void init_pd_latency(struct shared_resource *resp)
+{
+       struct pd_latency_db *pd_lat_db;
+
+       resp->no_of_users = 0;
+       resp->curr_level = PD_LATENCY_OFF;
+       pd_lat_db = resp->resource_data;
+       /* Populate the power domain associated with the latency resource */
+       pd_lat_db->pd = pwrdm_lookup(pd_lat_db->pwrdm_name);
+       return;
+}
+
+/**
+ * set_pd_latency - Updates the curr_level of the power domain resource.
+ * @resp: Power domain latency resource.
+ * @latency: New latency value acceptable.
+ *
+ * This function maps the latency in microsecs to the acceptable
+ * Power domain state using the latency DB.
+ * It then programs the power domain to enter the target state.
+ * Always returns 0.
+ */
+int set_pd_latency(struct shared_resource *resp, u32 latency)
+{
+       u32 pd_lat_level, ind, i;
+       struct pd_latency_db *pd_lat_db;
+       struct powerdomain *pwrdm;
+
+       pd_lat_db = resp->resource_data;
+       pwrdm = pd_lat_db->pd;
+       pd_lat_level = PD_LATENCY_OFF;
+       /* using the latency db map to the appropriate PD state */
+       for (ind = 0; ind < PD_LATENCY_MAXLEVEL; ind++)
+               if (pd_lat_db->latency[ind] < latency)
+                       pd_lat_level = ind;
+
+       resp->curr_level = pd_lat_level;
+       switch (pd_lat_level) {
+       case PWRDM_POWER_OFF:
+       case PWRDM_POWER_RET:
+               /* Errata 1.29: No transitions from INACTIVE to RET/OFF
+                * possible.
+                * Need to be taken care of here.
+                */
+               if (pwrdm_read_pwrst(pwrdm) != PWRDM_POWER_ON) {
+                       /* Force the clock domains to ON */
+                       for (i = 0; pwrdm->pwrdm_clkdms[i]; i++) {
+                               omap2_clkdm_deny_idle(pwrdm->pwrdm_clkdms[i]);
+                               omap2_clkdm_wakeup(pwrdm->pwrdm_clkdms[i]);
+                       }
+                       pwrdm_set_next_pwrst(pwrdm, PWRDM_POWER_ON);
+                       pwrdm_set_next_pwrst(pwrdm, pd_lat_level);
+                       for (i = 0; pwrdm->pwrdm_clkdms[i]; i++) {
+                               omap2_clkdm_sleep(pwrdm->pwrdm_clkdms[i]);
+                               omap2_clkdm_allow_idle(pwrdm->pwrdm_clkdms[i]);
+                       }
+               } else
+                       pwrdm_set_next_pwrst(pwrdm, pd_lat_level);
+               break;
+       case PWRDM_POWER_ON:
+               pwrdm_set_next_pwrst(pwrdm, PWRDM_POWER_ON);
+               break;
+       default:
+               break;
+       }
+       return 0;
+}


--
To unsubscribe from this list: send the line "unsubscribe linux-omap" in
the body of a message to [EMAIL PROTECTED]
More majordomo info at  http://vger.kernel.org/majordomo-info.html

Reply via email to