[deliverable/linux.git] / sound / pci / ctxfi / ctresource.c

/**
 * Copyright (C) 2008, Creative Technology Ltd. All Rights Reserved.
 *
 * This source file is released under GPL v2 license (no other versions).
 * See the COPYING file included in the main directory of this source
 * distribution for the license terms and conditions.
 *
 * @File	ctresource.c
 *
 * @Brief
 * This file contains the implementation of some generic helper functions.
 *
 * @Author	Liu Chun
 * @Date 	May 15 2008
 *
 */

#include "ctresource.h"
#include "cthardware.h"
#include <linux/err.h>
#include <linux/slab.h>

#define AUDIO_SLOT_BLOCK_NUM 	256

/* Resource allocation based on bit-map management mechanism */
static int
get_resource(u8 *rscs, unsigned int amount,
	     unsigned int multi, unsigned int *ridx)
{
	int i, j, k, n;

	/* Check whether there are sufficient resources to meet request. */
	for (i = 0, n = multi; i < amount; i++) {
		j = i / 8;
		k = i % 8;
		if (rscs[j] & ((u8)1 << k)) {
			n = multi;
			continue;
		}
		if (!(--n))
			break; /* found sufficient contiguous resources */
	}

	if (i >= amount) {
		/* Can not find sufficient contiguous resources */
		return -ENOENT;
	}

	/* Mark the contiguous bits in resource bit-map as used */
	for (n = multi; n > 0; n--) {
		j = i / 8;
		k = i % 8;
		rscs[j] |= ((u8)1 << k);
		i--;
	}

	*ridx = i + 1;

	return 0;
}

static int put_resource(u8 *rscs, unsigned int multi, unsigned int idx)
{
	unsigned int i, j, k, n;

	/* Mark the contiguous bits in resource bit-map as used */
	for (n = multi, i = idx; n > 0; n--) {
		j = i / 8;
		k = i % 8;
		rscs[j] &= ~((u8)1 << k);
		i++;
	}

	return 0;
}

int mgr_get_resource(struct rsc_mgr *mgr, unsigned int n, unsigned int *ridx)
{
	int err;

	if (n > mgr->avail)
		return -ENOENT;

	err = get_resource(mgr->rscs, mgr->amount, n, ridx);
	if (!err)
		mgr->avail -= n;

	return err;
}

int mgr_put_resource(struct rsc_mgr *mgr, unsigned int n, unsigned int idx)
{
	put_resource(mgr->rscs, n, idx);
	mgr->avail += n;

	return 0;
}

static unsigned char offset_in_audio_slot_block[NUM_RSCTYP] = {
	/* SRC channel is at Audio Ring slot 1 every 16 slots. */
	[SRC]		= 0x1,
	[AMIXER]	= 0x4,
	[SUM]		= 0xc,
};

static int rsc_index(const struct rsc *rsc)
{
    return rsc->conj;
}

static int audio_ring_slot(const struct rsc *rsc)
{
    return (rsc->conj << 4) + offset_in_audio_slot_block[rsc->type];
}

static int rsc_next_conj(struct rsc *rsc)
{
	unsigned int i;
	for (i = 0; (i < 8) && (!(rsc->msr & (0x1 << i))); )
		i++;
	rsc->conj += (AUDIO_SLOT_BLOCK_NUM >> i);
	return rsc->conj;
}

static int rsc_master(struct rsc *rsc)
{
	return rsc->conj = rsc->idx;
}

static struct rsc_ops rsc_generic_ops = {
	.index		= rsc_index,
	.output_slot	= audio_ring_slot,
	.master		= rsc_master,
	.next_conj	= rsc_next_conj,
};

int rsc_init(struct rsc *rsc, u32 idx, enum RSCTYP type, u32 msr, void *hw)
{
	int err = 0;

	rsc->idx = idx;
	rsc->conj = idx;
	rsc->type = type;
	rsc->msr = msr;
	rsc->hw = hw;
	rsc->ops = &rsc_generic_ops;
	if (!hw) {
		rsc->ctrl_blk = NULL;
		return 0;
	}

	switch (type) {
	case SRC:
		err = ((struct hw *)hw)->src_rsc_get_ctrl_blk(&rsc->ctrl_blk);
		break;
	case AMIXER:
		err = ((struct hw *)hw)->
				amixer_rsc_get_ctrl_blk(&rsc->ctrl_blk);
		break;
	case SRCIMP:
	case SUM:
	case DAIO:
		break;
	default:
		printk(KERN_ERR
		       "ctxfi: Invalid resource type value %d!\n", type);
		return -EINVAL;
	}

	if (err) {
		printk(KERN_ERR
		       "ctxfi: Failed to get resource control block!\n");
		return err;
	}

	return 0;
}

int rsc_uninit(struct rsc *rsc)
{
	if ((NULL != rsc->hw) && (NULL != rsc->ctrl_blk)) {
		switch (rsc->type) {
		case SRC:
			((struct hw *)rsc->hw)->
				src_rsc_put_ctrl_blk(rsc->ctrl_blk);
			break;
		case AMIXER:
			((struct hw *)rsc->hw)->
				amixer_rsc_put_ctrl_blk(rsc->ctrl_blk);
			break;
		case SUM:
		case DAIO:
			break;
		default:
			printk(KERN_ERR "ctxfi: "
			       "Invalid resource type value %d!\n", rsc->type);
			break;
		}

		rsc->hw = rsc->ctrl_blk = NULL;
	}

	rsc->idx = rsc->conj = 0;
	rsc->type = NUM_RSCTYP;
	rsc->msr = 0;

	return 0;
}

int rsc_mgr_init(struct rsc_mgr *mgr, enum RSCTYP type,
		 unsigned int amount, void *hw_obj)
{
	int err = 0;
	struct hw *hw = hw_obj;

	mgr->type = NUM_RSCTYP;

	mgr->rscs = kzalloc(((amount + 8 - 1) / 8), GFP_KERNEL);
	if (!mgr->rscs)
		return -ENOMEM;

	switch (type) {
	case SRC:
		err = hw->src_mgr_get_ctrl_blk(&mgr->ctrl_blk);
		break;
	case SRCIMP:
		err = hw->srcimp_mgr_get_ctrl_blk(&mgr->ctrl_blk);
		break;
	case AMIXER:
		err = hw->amixer_mgr_get_ctrl_blk(&mgr->ctrl_blk);
		break;
	case DAIO:
		err = hw->daio_mgr_get_ctrl_blk(hw, &mgr->ctrl_blk);
		break;
	case SUM:
		break;
	default:
		printk(KERN_ERR
		       "ctxfi: Invalid resource type value %d!\n", type);
		err = -EINVAL;
		goto error;
	}

	if (err) {
		printk(KERN_ERR
		       "ctxfi: Failed to get manager control block!\n");
		goto error;
	}

	mgr->type = type;
	mgr->avail = mgr->amount = amount;
	mgr->hw = hw;

	return 0;

error:
	kfree(mgr->rscs);
	return err;
}

int rsc_mgr_uninit(struct rsc_mgr *mgr)
{
	if (NULL != mgr->rscs) {
		kfree(mgr->rscs);
		mgr->rscs = NULL;
	}

	if ((NULL != mgr->hw) && (NULL != mgr->ctrl_blk)) {
		switch (mgr->type) {
		case SRC:
			((struct hw *)mgr->hw)->
				src_mgr_put_ctrl_blk(mgr->ctrl_blk);
			break;
		case SRCIMP:
			((struct hw *)mgr->hw)->
				srcimp_mgr_put_ctrl_blk(mgr->ctrl_blk);
			break;
		case AMIXER:
			((struct hw *)mgr->hw)->
				amixer_mgr_put_ctrl_blk(mgr->ctrl_blk);
			break;
		case DAIO:
			((struct hw *)mgr->hw)->
				daio_mgr_put_ctrl_blk(mgr->ctrl_blk);
			break;
		case SUM:
			break;
		default:
			printk(KERN_ERR "ctxfi: "
			       "Invalid resource type value %d!\n", mgr->type);
			break;
		}

		mgr->hw = mgr->ctrl_blk = NULL;
	}

	mgr->type = NUM_RSCTYP;
	mgr->avail = mgr->amount = 0;

	return 0;
}
Commit	Line	Data
8cc72361 WYC	1	/**
	2	* Copyright (C) 2008, Creative Technology Ltd. All Rights Reserved.
	3	*
	4	* This source file is released under GPL v2 license (no other versions).
	5	* See the COPYING file included in the main directory of this source
	6	* distribution for the license terms and conditions.
	7	*
	8	* @File ctresource.c
	9	*
	10	* @Brief
	11	* This file contains the implementation of some generic helper functions.
	12	*
	13	* @Author Liu Chun
	14	* @Date May 15 2008
	15	*
	16	*/
	17
	18	#include "ctresource.h"
	19	#include "cthardware.h"
	20	#include <linux/err.h>
	21	#include <linux/slab.h>
	22
	23	#define AUDIO_SLOT_BLOCK_NUM 256
	24
	25	/* Resource allocation based on bit-map management mechanism */
	26	static int
	27	get_resource(u8 *rscs, unsigned int amount,
	28	unsigned int multi, unsigned int *ridx)
	29	{
514eef9c	30	int i, j, k, n;
8cc72361 WYC	31
	32	/* Check whether there are sufficient resources to meet request. */
	33	for (i = 0, n = multi; i < amount; i++) {
	34	j = i / 8;
	35	k = i % 8;
	36	if (rscs[j] & ((u8)1 << k)) {
	37	n = multi;
	38	continue;
	39	}
	40	if (!(--n))
	41	break; /* found sufficient contiguous resources */
	42	}
	43
	44	if (i >= amount) {
	45	/* Can not find sufficient contiguous resources */
	46	return -ENOENT;
	47	}
	48
	49	/* Mark the contiguous bits in resource bit-map as used */
	50	for (n = multi; n > 0; n--) {
	51	j = i / 8;
	52	k = i % 8;
	53	rscs[j] \|= ((u8)1 << k);
	54	i--;
	55	}
	56
	57	*ridx = i + 1;
	58
	59	return 0;
	60	}
	61
	62	static int put_resource(u8 *rscs, unsigned int multi, unsigned int idx)
	63	{
514eef9c	64	unsigned int i, j, k, n;
8cc72361 WYC	65
	66	/* Mark the contiguous bits in resource bit-map as used */
	67	for (n = multi, i = idx; n > 0; n--) {
	68	j = i / 8;
	69	k = i % 8;
	70	rscs[j] &= ~((u8)1 << k);
	71	i++;
	72	}
	73
	74	return 0;
	75	}
	76
	77	int mgr_get_resource(struct rsc_mgr mgr, unsigned int n, unsigned int ridx)
	78	{
514eef9c	79	int err;
8cc72361 WYC	80
	81	if (n > mgr->avail)
	82	return -ENOENT;
	83
	84	err = get_resource(mgr->rscs, mgr->amount, n, ridx);
	85	if (!err)
	86	mgr->avail -= n;
	87
	88	return err;
	89	}
	90
	91	int mgr_put_resource(struct rsc_mgr *mgr, unsigned int n, unsigned int idx)
	92	{
	93	put_resource(mgr->rscs, n, idx);
	94	mgr->avail += n;
	95
	96	return 0;
	97	}
	98
	99	static unsigned char offset_in_audio_slot_block[NUM_RSCTYP] = {
	100	/* SRC channel is at Audio Ring slot 1 every 16 slots. */
	101	[SRC] = 0x1,
	102	[AMIXER] = 0x4,
	103	[SUM] = 0xc,
	104	};
	105
	106	static int rsc_index(const struct rsc *rsc)
	107	{
	108	return rsc->conj;
	109	}
	110
	111	static int audio_ring_slot(const struct rsc *rsc)
	112	{
	113	return (rsc->conj << 4) + offset_in_audio_slot_block[rsc->type];
	114	}
	115
	116	static int rsc_next_conj(struct rsc *rsc)
	117	{
	118	unsigned int i;
	119	for (i = 0; (i < 8) && (!(rsc->msr & (0x1 << i))); )
	120	i++;
	121	rsc->conj += (AUDIO_SLOT_BLOCK_NUM >> i);
	122	return rsc->conj;
	123	}
	124
	125	static int rsc_master(struct rsc *rsc)
	126	{
	127	return rsc->conj = rsc->idx;
	128	}
	129
	130	static struct rsc_ops rsc_generic_ops = {
	131	.index = rsc_index,
	132	.output_slot = audio_ring_slot,
	133	.master = rsc_master,
	134	.next_conj = rsc_next_conj,
	135	};
	136
	137	int rsc_init(struct rsc rsc, u32 idx, enum RSCTYP type, u32 msr, void hw)
	138	{
	139	int err = 0;
	140
	141	rsc->idx = idx;
	142	rsc->conj = idx;
	143	rsc->type = type;
144	rsc->msr = msr;
145	rsc->hw = hw;
146	rsc->ops = &rsc_generic_ops;
35ebf6e7	147	if (!hw) {
8cc72361 WYC	148	rsc->ctrl_blk = NULL;
	149	return 0;
	150	}
	151
	152	switch (type) {
	153	case SRC:
	154	err = ((struct hw *)hw)->src_rsc_get_ctrl_blk(&rsc->ctrl_blk);
	155	break;
	156	case AMIXER:
	157	err = ((struct hw *)hw)->
	158	amixer_rsc_get_ctrl_blk(&rsc->ctrl_blk);
	159	break;
	160	case SRCIMP:
	161	case SUM:
	162	case DAIO:
	163	break;
	164	default:
b3e0afe6 TI	165	printk(KERN_ERR
b3e0afe6 TI	166	"ctxfi: Invalid resource type value %d!\n", type);
8cc72361 WYC	167	return -EINVAL;
	168	}
	169
	170	if (err) {
b3e0afe6 TI	171	printk(KERN_ERR
b3e0afe6 TI	172	"ctxfi: Failed to get resource control block!\n");
8cc72361 WYC	173	return err;
	174	}
	175
	176	return 0;
	177	}
	178
	179	int rsc_uninit(struct rsc *rsc)
	180	{
	181	if ((NULL != rsc->hw) && (NULL != rsc->ctrl_blk)) {
	182	switch (rsc->type) {
	183	case SRC:
	184	((struct hw *)rsc->hw)->
	185	src_rsc_put_ctrl_blk(rsc->ctrl_blk);
	186	break;
	187	case AMIXER:
	188	((struct hw *)rsc->hw)->
	189	amixer_rsc_put_ctrl_blk(rsc->ctrl_blk);
	190	break;
	191	case SUM:
	192	case DAIO:
	193	break;
	194	default:
b3e0afe6 TI	195	printk(KERN_ERR "ctxfi: "
b3e0afe6 TI	196	"Invalid resource type value %d!\n", rsc->type);
8cc72361 WYC	197	break;
	198	}
	199
	200	rsc->hw = rsc->ctrl_blk = NULL;
	201	}
	202
	203	rsc->idx = rsc->conj = 0;
	204	rsc->type = NUM_RSCTYP;
	205	rsc->msr = 0;
	206
	207	return 0;
	208	}
	209
	210	int rsc_mgr_init(struct rsc_mgr *mgr, enum RSCTYP type,
	211	unsigned int amount, void *hw_obj)
	212	{
	213	int err = 0;
	214	struct hw *hw = hw_obj;
	215
	216	mgr->type = NUM_RSCTYP;
	217
	218	mgr->rscs = kzalloc(((amount + 8 - 1) / 8), GFP_KERNEL);
35ebf6e7	219	if (!mgr->rscs)
8cc72361 WYC	220	return -ENOMEM;
	221
	222	switch (type) {
	223	case SRC:
	224	err = hw->src_mgr_get_ctrl_blk(&mgr->ctrl_blk);
	225	break;
	226	case SRCIMP:
	227	err = hw->srcimp_mgr_get_ctrl_blk(&mgr->ctrl_blk);
	228	break;
	229	case AMIXER:
	230	err = hw->amixer_mgr_get_ctrl_blk(&mgr->ctrl_blk);
	231	break;
	232	case DAIO:
	233	err = hw->daio_mgr_get_ctrl_blk(hw, &mgr->ctrl_blk);
	234	break;
	235	case SUM:
	236	break;
	237	default:
b3e0afe6 TI	238	printk(KERN_ERR
b3e0afe6 TI	239	"ctxfi: Invalid resource type value %d!\n", type);
8cc72361 WYC	240	err = -EINVAL;
	241	goto error;
	242	}
	243
	244	if (err) {
b3e0afe6 TI	245	printk(KERN_ERR
b3e0afe6 TI	246	"ctxfi: Failed to get manager control block!\n");
8cc72361 WYC	247	goto error;
	248	}
	249
	250	mgr->type = type;
	251	mgr->avail = mgr->amount = amount;
	252	mgr->hw = hw;
	253
	254	return 0;
	255
	256	error:
	257	kfree(mgr->rscs);
	258	return err;
	259	}
	260
	261	int rsc_mgr_uninit(struct rsc_mgr *mgr)
	262	{
	263	if (NULL != mgr->rscs) {
	264	kfree(mgr->rscs);
	265	mgr->rscs = NULL;
	266	}
	267
	268	if ((NULL != mgr->hw) && (NULL != mgr->ctrl_blk)) {
	269	switch (mgr->type) {
	270	case SRC:
	271	((struct hw *)mgr->hw)->
	272	src_mgr_put_ctrl_blk(mgr->ctrl_blk);
	273	break;
	274	case SRCIMP:
	275	((struct hw *)mgr->hw)->
	276	srcimp_mgr_put_ctrl_blk(mgr->ctrl_blk);
	277	break;
	278	case AMIXER:
	279	((struct hw *)mgr->hw)->
	280	amixer_mgr_put_ctrl_blk(mgr->ctrl_blk);
	281	break;
	282	case DAIO:
	283	((struct hw *)mgr->hw)->
	284	daio_mgr_put_ctrl_blk(mgr->ctrl_blk);
	285	break;
	286	case SUM:
	287	break;
	288	default:
b3e0afe6 TI	289	printk(KERN_ERR "ctxfi: "
b3e0afe6 TI	290	"Invalid resource type value %d!\n", mgr->type);
8cc72361 WYC	291	break;
	292	}
	293
	294	mgr->hw = mgr->ctrl_blk = NULL;
	295	}
	296
	297	mgr->type = NUM_RSCTYP;
	298	mgr->avail = mgr->amount = 0;
	299
	300	return 0;
	301	}