/drivers/staging/tidspbridge/rmgr/pwr.c

  1/*
  2 * pwr.c
  3 *
  4 * DSP-BIOS Bridge driver support functions for TI OMAP processors.
  5 *
  6 * PWR API for controlling DSP power states.
  7 *
  8 * Copyright (C) 2005-2006 Texas Instruments, Inc.
  9 *
 10 * This package 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 * THIS PACKAGE IS PROVIDED ``AS IS'' AND WITHOUT ANY EXPRESS OR
 15 * IMPLIED WARRANTIES, INCLUDING, WITHOUT LIMITATION, THE IMPLIED
 16 * WARRANTIES OF MERCHANTIBILITY AND FITNESS FOR A PARTICULAR PURPOSE.
 17 */
 18
 19/*  ----------------------------------- Host OS */
 20#include <dspbridge/host_os.h>
 21
 22/*  ----------------------------------- This */
 23#include <dspbridge/pwr.h>
 24
 25/*  ----------------------------------- Resource Manager */
 26#include <dspbridge/devdefs.h>
 27#include <dspbridge/drv.h>
 28
 29/*  ----------------------------------- Platform Manager */
 30#include <dspbridge/dev.h>
 31
 32/*  ----------------------------------- Link Driver */
 33#include <dspbridge/dspioctl.h>
 34
 35/*
 36 *  ======== pwr_sleep_dsp ========
 37 *    Send command to DSP to enter sleep state.
 38 */
 39int pwr_sleep_dsp(const u32 sleep_code, const u32 timeout)
 40{
 41	struct bridge_drv_interface *intf_fxns;
 42	struct bridge_dev_context *dw_context;
 43	int status = -EPERM;
 44	struct dev_object *hdev_obj = NULL;
 45	u32 ioctlcode = 0;
 46	u32 arg = timeout;
 47
 48	for (hdev_obj = (struct dev_object *)drv_get_first_dev_object();
 49	     hdev_obj != NULL;
 50	     hdev_obj =
 51	     (struct dev_object *)drv_get_next_dev_object((u32) hdev_obj)) {
 52		if (dev_get_bridge_context(hdev_obj,
 53						(struct bridge_dev_context **)
 54						   &dw_context)) {
 55			continue;
 56		}
 57		if (dev_get_intf_fxns(hdev_obj,
 58						(struct bridge_drv_interface **)
 59						&intf_fxns)) {
 60			continue;
 61		}
 62		if (sleep_code == PWR_DEEPSLEEP)
 63			ioctlcode = BRDIOCTL_DEEPSLEEP;
 64		else if (sleep_code == PWR_EMERGENCYDEEPSLEEP)
 65			ioctlcode = BRDIOCTL_EMERGENCYSLEEP;
 66		else
 67			status = -EINVAL;
 68
 69		if (status != -EINVAL) {
 70			status = (*intf_fxns->dev_cntrl) (dw_context,
 71							      ioctlcode,
 72							      (void *)&arg);
 73		}
 74	}
 75	return status;
 76}
 77
 78/*
 79 *  ======== pwr_wake_dsp ========
 80 *    Send command to DSP to wake it from sleep.
 81 */
 82int pwr_wake_dsp(const u32 timeout)
 83{
 84	struct bridge_drv_interface *intf_fxns;
 85	struct bridge_dev_context *dw_context;
 86	int status = -EPERM;
 87	struct dev_object *hdev_obj = NULL;
 88	u32 arg = timeout;
 89
 90	for (hdev_obj = (struct dev_object *)drv_get_first_dev_object();
 91	     hdev_obj != NULL;
 92	     hdev_obj = (struct dev_object *)drv_get_next_dev_object
 93	     ((u32) hdev_obj)) {
 94		if (!(dev_get_bridge_context(hdev_obj,
 95						      (struct bridge_dev_context
 96						       **)&dw_context))) {
 97			if (!(dev_get_intf_fxns(hdev_obj,
 98			      (struct bridge_drv_interface **)&intf_fxns))) {
 99				status =
100				    (*intf_fxns->dev_cntrl) (dw_context,
101							BRDIOCTL_WAKEUP,
102							(void *)&arg);
103			}
104		}
105	}
106	return status;
107}
108
109/*
110 *  ======== pwr_pm_pre_scale========
111 *    Sends pre-notification message to DSP.
112 */
113int pwr_pm_pre_scale(u16 voltage_domain, u32 level)
114{
115	struct bridge_drv_interface *intf_fxns;
116	struct bridge_dev_context *dw_context;
117	int status = -EPERM;
118	struct dev_object *hdev_obj = NULL;
119	u32 arg[2];
120
121	arg[0] = voltage_domain;
122	arg[1] = level;
123
124	for (hdev_obj = (struct dev_object *)drv_get_first_dev_object();
125	     hdev_obj != NULL;
126	     hdev_obj = (struct dev_object *)drv_get_next_dev_object
127	     ((u32) hdev_obj)) {
128		if (!(dev_get_bridge_context(hdev_obj,
129						      (struct bridge_dev_context
130						       **)&dw_context))) {
131			if (!(dev_get_intf_fxns(hdev_obj,
132			      (struct bridge_drv_interface **)&intf_fxns))) {
133				status =
134				    (*intf_fxns->dev_cntrl) (dw_context,
135						BRDIOCTL_PRESCALE_NOTIFY,
136						(void *)&arg);
137			}
138		}
139	}
140	return status;
141}
142
143/*
144 *  ======== pwr_pm_post_scale========
145 *    Sends post-notification message to DSP.
146 */
147int pwr_pm_post_scale(u16 voltage_domain, u32 level)
148{
149	struct bridge_drv_interface *intf_fxns;
150	struct bridge_dev_context *dw_context;
151	int status = -EPERM;
152	struct dev_object *hdev_obj = NULL;
153	u32 arg[2];
154
155	arg[0] = voltage_domain;
156	arg[1] = level;
157
158	for (hdev_obj = (struct dev_object *)drv_get_first_dev_object();
159	     hdev_obj != NULL;
160	     hdev_obj = (struct dev_object *)drv_get_next_dev_object
161	     ((u32) hdev_obj)) {
162		if (!(dev_get_bridge_context(hdev_obj,
163						      (struct bridge_dev_context
164						       **)&dw_context))) {
165			if (!(dev_get_intf_fxns(hdev_obj,
166			      (struct bridge_drv_interface **)&intf_fxns))) {
167				status =
168				    (*intf_fxns->dev_cntrl) (dw_context,
169						BRDIOCTL_POSTSCALE_NOTIFY,
170						(void *)&arg);
171			}
172		}
173	}
174	return status;
175
176}