/drivers/staging/tidspbridge/rmgr/dspdrv.c

  1/*
  2 * dspdrv.c
  3 *
  4 * DSP-BIOS Bridge driver support functions for TI OMAP processors.
  5 *
  6 * Interface to allocate and free bridge resources.
  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 <linux/types.h>
 21#include <dspbridge/host_os.h>
 22
 23/*  ----------------------------------- DSP/BIOS Bridge */
 24#include <dspbridge/dbdefs.h>
 25
 26/*  ----------------------------------- Trace & Debug */
 27#include <dspbridge/dbc.h>
 28
 29/*  ----------------------------------- Platform Manager */
 30#include <dspbridge/drv.h>
 31#include <dspbridge/dev.h>
 32#include <dspbridge/dspapi.h>
 33
 34/*  ----------------------------------- Resource Manager */
 35#include <dspbridge/mgr.h>
 36
 37/*  ----------------------------------- This */
 38#include <dspbridge/dspdrv.h>
 39
 40/*
 41 *  ======== dsp_init ========
 42 *  	Allocates bridge resources. Loads a base image onto DSP, if specified.
 43 */
 44u32 dsp_init(u32 *init_status)
 45{
 46	char dev_node[MAXREGPATHLENGTH] = "TIOMAP1510";
 47	int status = -EPERM;
 48	struct drv_object *drv_obj = NULL;
 49	u32 device_node;
 50	u32 device_node_string;
 51
 52	if (!api_init())
 53		goto func_cont;
 54
 55	status = drv_create(&drv_obj);
 56	if (status) {
 57		api_exit();
 58		goto func_cont;
 59	}
 60
 61	/* End drv_create */
 62	/* Request Resources */
 63	status = drv_request_resources((u32) &dev_node, &device_node_string);
 64	if (!status) {
 65		/* Attempt to Start the Device */
 66		status = dev_start_device((struct cfg_devnode *)
 67					  device_node_string);
 68		if (status)
 69			(void)drv_release_resources
 70			    ((u32) device_node_string, drv_obj);
 71	} else {
 72		dev_dbg(bridge, "%s: drv_request_resources Failed\n", __func__);
 73		status = -EPERM;
 74	}
 75
 76	/* Unwind whatever was loaded */
 77	if (status) {
 78		/* irrespective of the status of dev_remove_device we conitinue
 79		 * unloading. Get the Driver Object iterate through and remove.
 80		 * Reset the status to E_FAIL to avoid going through
 81		 * api_init_complete2. */
 82		for (device_node = drv_get_first_dev_extension();
 83		     device_node != 0;
 84		     device_node = drv_get_next_dev_extension(device_node)) {
 85			(void)dev_remove_device((struct cfg_devnode *)
 86						device_node);
 87			(void)drv_release_resources((u32) device_node, drv_obj);
 88		}
 89		/* Remove the Driver Object */
 90		(void)drv_destroy(drv_obj);
 91		drv_obj = NULL;
 92		api_exit();
 93		dev_dbg(bridge, "%s: Logical device failed init\n", __func__);
 94	}			/* Unwinding the loaded drivers */
 95func_cont:
 96	/* Attempt to Start the Board */
 97	if (!status) {
 98		/* BRD_AutoStart could fail if the dsp execuetable is not the
 99		 * correct one. We should not propagate that error
100		 * into the device loader. */
101		(void)api_init_complete2();
102	} else {
103		dev_dbg(bridge, "%s: Failed\n", __func__);
104	}			/* End api_init_complete2 */
105	DBC_ENSURE((!status && drv_obj != NULL) ||
106		   (status && drv_obj == NULL));
107	*init_status = status;
108	/* Return the Driver Object */
109	return (u32) drv_obj;
110}
111
112/*
113 *  ======== dsp_deinit ========
114 *  	Frees the resources allocated for bridge.
115 */
116bool dsp_deinit(u32 device_context)
117{
118	bool ret = true;
119	u32 device_node;
120	struct mgr_object *mgr_obj = NULL;
121	struct drv_data *drv_datap = dev_get_drvdata(bridge);
122
123	while ((device_node = drv_get_first_dev_extension()) != 0) {
124		(void)dev_remove_device((struct cfg_devnode *)device_node);
125
126		(void)drv_release_resources((u32) device_node,
127					(struct drv_object *)device_context);
128	}
129
130	(void)drv_destroy((struct drv_object *)device_context);
131
132	/* Get the Manager Object from driver data
133	 * MGR Destroy will unload the DCD dll */
134	if (drv_datap && drv_datap->mgr_object) {
135		mgr_obj = drv_datap->mgr_object;
136		(void)mgr_destroy(mgr_obj);
137	} else {
138		pr_err("%s: Failed to retrieve the object handle\n", __func__);
139	}
140
141	api_exit();
142
143	return ret;
144}