task_test5.c

Omap5910 上实现双核通信 DSP GateWay

/*
 * Copyright (c) 2002-2005, Nokia
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions are met:
 *
 * Redistributions of source code must retain the above copyright notice, this
 * list of conditions and the following disclaimer. 
 *
 * Redistributions in binary form must reproduce the above copyright notice,
 * this list of conditions and the following disclaimer in the documentation
 * and/or other materials provided with the distribution. 
 *
 * Neither the name of Nokia nor the names of its contributors may be used to
 * endorse or promote products derived from this software without specific
 * prior written permission. 
 *
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
 * POSSIBILITY OF SUCH DAMAGE.
 *
 * Toshihiro Kobayashi <[e-mail]>
 * 2004/07/15:  DSP Gateway version 3.3
 */

#include <std.h>
#include <mem.h>
#include "mailbox.h"
#include "tokliBIOS.h"

struct t5_udata {
	Void *t1q_id;
	Int waiting;
};

static Uns t5_rcv_wdsnd(struct dsptask *task, Uns data)
{
	struct t5_udata *udata = task->udata;

	wdsnd(task, data);	/* echo back */
	udata->waiting = 0;

	return 0;
}

static Uns t5_snd_wdreq(struct dsptask *task)
{
	struct t5_udata *udata = task->udata;

	if (!udata->waiting)
		wdreq(task);
	udata->waiting = 1;
	return 0;
}

static Uns t5_rcv_tctl(struct dsptask *task, Uns ctlcmd, Uns *ret, Uns arg)
{
	struct t5_udata *udata = task->udata;

	switch (ctlcmd) {
		case MBCMD_TCTL_TEN:
			if (udata->t1q_id != MEM_ILLEGAL)
				/* already registered */
				return 0;
			udata->t1q_id = register_tq_1s(task, t5_snd_wdreq);
			if (udata->t1q_id == MEM_ILLEGAL)
				return MBCMD_EID_NORES;
			udata->waiting = 0;
			return 0;
		case MBCMD_TCTL_TDIS:
			unregister_tq_1s(task, udata->t1q_id);
			udata->t1q_id = MEM_ILLEGAL;
			return 0;
		default:
			return MBCMD_EID_BADTCTL;
	}
}

static struct t5_udata udata = { MEM_ILLEGAL, 0 };

#pragma DATA_SECTION(task_test5, "dspgw_task")
struct dsptask task_test5 = {
	TID_MAGIC,	/* tid */
	"test5",	/* name */
	MBCMD_TTYP_WDDM | MBCMD_TTYP_WDMD |
	MBCMD_TTYP_ASND | MBCMD_TTYP_ARCV,
			/* ttyp: active word snd, active word rcv */
	t5_rcv_wdsnd,	/* rcv_snd */
	NULL,		/* rcv_req */
	t5_rcv_tctl,	/* rcv_tctl */
	NULL,		/* tsk_attrs */
	NULL,		/* mmap_info */
	&udata		/* udata; */
};