[deliverable/linux.git] / sound / core / pcm_iec958.c

/*
 *  PCM DRM helpers
 *
 *   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.
 */
#include <linux/export.h>
#include <linux/types.h>
#include <sound/asoundef.h>
#include <sound/pcm.h>
#include <sound/pcm_params.h>
#include <sound/pcm_iec958.h>

static int create_iec958_consumer(uint rate, uint sample_width,
				  u8 *cs, size_t len)
{
	unsigned int fs, ws;

	if (len < 4)
		return -EINVAL;

	switch (rate) {
	case 32000:
		fs = IEC958_AES3_CON_FS_32000;
		break;
	case 44100:
		fs = IEC958_AES3_CON_FS_44100;
		break;
	case 48000:
		fs = IEC958_AES3_CON_FS_48000;
		break;
	case 88200:
		fs = IEC958_AES3_CON_FS_88200;
		break;
	case 96000:
		fs = IEC958_AES3_CON_FS_96000;
		break;
	case 176400:
		fs = IEC958_AES3_CON_FS_176400;
		break;
	case 192000:
		fs = IEC958_AES3_CON_FS_192000;
		break;
	default:
		return -EINVAL;
	}

	if (len > 4) {
		switch (sample_width) {
		case 16:
			ws = IEC958_AES4_CON_WORDLEN_20_16;
			break;
		case 18:
			ws = IEC958_AES4_CON_WORDLEN_22_18;
			break;
		case 20:
			ws = IEC958_AES4_CON_WORDLEN_20_16 |
			     IEC958_AES4_CON_MAX_WORDLEN_24;
			break;
		case 24:
		case 32: /* Assume 24-bit width for 32-bit samples. */
			ws = IEC958_AES4_CON_WORDLEN_24_20 |
			     IEC958_AES4_CON_MAX_WORDLEN_24;
			break;

		default:
			return -EINVAL;
		}
	}

	memset(cs, 0, len);

	cs[0] = IEC958_AES0_CON_NOT_COPYRIGHT | IEC958_AES0_CON_EMPHASIS_NONE;
	cs[1] = IEC958_AES1_CON_GENERAL;
	cs[2] = IEC958_AES2_CON_SOURCE_UNSPEC | IEC958_AES2_CON_CHANNEL_UNSPEC;
	cs[3] = IEC958_AES3_CON_CLOCK_1000PPM | fs;

	if (len > 4)
		cs[4] = ws;

	return len;
}

/**
 * snd_pcm_create_iec958_consumer - create consumer format IEC958 channel status
 * @runtime: pcm runtime structure with ->rate filled in
 * @cs: channel status buffer, at least four bytes
 * @len: length of channel status buffer
 *
 * Create the consumer format channel status data in @cs of maximum size
 * @len corresponding to the parameters of the PCM runtime @runtime.
 *
 * Drivers may wish to tweak the contents of the buffer after creation.
 *
 * Returns: length of buffer, or negative error code if something failed.
 */
int snd_pcm_create_iec958_consumer(struct snd_pcm_runtime *runtime, u8 *cs,
	size_t len)
{
	return create_iec958_consumer(runtime->rate,
				      snd_pcm_format_width(runtime->format),
				      cs, len);
}
EXPORT_SYMBOL(snd_pcm_create_iec958_consumer);

/**
 * snd_pcm_create_iec958_consumer_hw_params - create IEC958 channel status
 * @hw_params: the hw_params instance for extracting rate and sample format
 * @cs: channel status buffer, at least four bytes
 * @len: length of channel status buffer
 *
 * Create the consumer format channel status data in @cs of maximum size
 * @len corresponding to the parameters of the PCM runtime @runtime.
 *
 * Drivers may wish to tweak the contents of the buffer after creation.
 *
 * Returns: length of buffer, or negative error code if something failed.
 */
int snd_pcm_create_iec958_consumer_hw_params(struct snd_pcm_hw_params *params,
					     u8 *cs, size_t len)
{
	return create_iec958_consumer(params_rate(params), params_width(params),
				      cs, len);
}
EXPORT_SYMBOL(snd_pcm_create_iec958_consumer_hw_params);
Commit	Line	Data
9203dd01 RK	1	/*
	2	* PCM DRM helpers
	3	*
	4	* This program is free software; you can redistribute it and/or modify
	5	* it under the terms of the GNU General Public License version 2 as
	6	* published by the Free Software Foundation.
	7	*/
	8	#include <linux/export.h>
	9	#include <linux/types.h>
	10	#include <sound/asoundef.h>
	11	#include <sound/pcm.h>
4a443657	12	#include <sound/pcm_params.h>
9203dd01 RK	13	#include <sound/pcm_iec958.h>
9203dd01 RK	14
4a443657 JS	15	static int create_iec958_consumer(uint rate, uint sample_width,
4a443657 JS	16	u8 *cs, size_t len)
9203dd01 RK	17	{
	18	unsigned int fs, ws;
	19
	20	if (len < 4)
	21	return -EINVAL;
	22
4a443657	23	switch (rate) {
9203dd01 RK	24	case 32000:
	25	fs = IEC958_AES3_CON_FS_32000;
	26	break;
	27	case 44100:
	28	fs = IEC958_AES3_CON_FS_44100;
	29	break;
	30	case 48000:
	31	fs = IEC958_AES3_CON_FS_48000;
	32	break;
	33	case 88200:
	34	fs = IEC958_AES3_CON_FS_88200;
	35	break;
	36	case 96000:
	37	fs = IEC958_AES3_CON_FS_96000;
	38	break;
	39	case 176400:
	40	fs = IEC958_AES3_CON_FS_176400;
	41	break;
	42	case 192000:
	43	fs = IEC958_AES3_CON_FS_192000;
	44	break;
	45	default:
	46	return -EINVAL;
	47	}
	48
	49	if (len > 4) {
4a443657	50	switch (sample_width) {
9203dd01 RK	51	case 16:
	52	ws = IEC958_AES4_CON_WORDLEN_20_16;
	53	break;
	54	case 18:
	55	ws = IEC958_AES4_CON_WORDLEN_22_18;
	56	break;
	57	case 20:
	58	ws = IEC958_AES4_CON_WORDLEN_20_16 \|
	59	IEC958_AES4_CON_MAX_WORDLEN_24;
	60	break;
	61	case 24:
4a462ce0	62	case 32: /* Assume 24-bit width for 32-bit samples. */
9203dd01 RK	63	ws = IEC958_AES4_CON_WORDLEN_24_20 \|
	64	IEC958_AES4_CON_MAX_WORDLEN_24;
	65	break;
	66
	67	default:
	68	return -EINVAL;
	69	}
	70	}
	71
	72	memset(cs, 0, len);
	73
	74	cs[0] = IEC958_AES0_CON_NOT_COPYRIGHT \| IEC958_AES0_CON_EMPHASIS_NONE;
	75	cs[1] = IEC958_AES1_CON_GENERAL;
	76	cs[2] = IEC958_AES2_CON_SOURCE_UNSPEC \| IEC958_AES2_CON_CHANNEL_UNSPEC;
	77	cs[3] = IEC958_AES3_CON_CLOCK_1000PPM \| fs;
	78
	79	if (len > 4)
	80	cs[4] = ws;
	81
	82	return len;
	83	}
4a443657 JS	84
	85	/**
	86	* snd_pcm_create_iec958_consumer - create consumer format IEC958 channel status
	87	* @runtime: pcm runtime structure with ->rate filled in
	88	* @cs: channel status buffer, at least four bytes
	89	* @len: length of channel status buffer
	90	*
	91	* Create the consumer format channel status data in @cs of maximum size
	92	* @len corresponding to the parameters of the PCM runtime @runtime.
	93	*
	94	* Drivers may wish to tweak the contents of the buffer after creation.
	95	*
	96	* Returns: length of buffer, or negative error code if something failed.
	97	*/
	98	int snd_pcm_create_iec958_consumer(struct snd_pcm_runtime runtime, u8 cs,
	99	size_t len)
	100	{
	101	return create_iec958_consumer(runtime->rate,
	102	snd_pcm_format_width(runtime->format),
	103	cs, len);
	104	}
9203dd01	105	EXPORT_SYMBOL(snd_pcm_create_iec958_consumer);
4a443657 JS	106
	107	/**
	108	* snd_pcm_create_iec958_consumer_hw_params - create IEC958 channel status
	109	* @hw_params: the hw_params instance for extracting rate and sample format
	110	* @cs: channel status buffer, at least four bytes
	111	* @len: length of channel status buffer
	112	*
	113	* Create the consumer format channel status data in @cs of maximum size
	114	* @len corresponding to the parameters of the PCM runtime @runtime.
	115	*
	116	* Drivers may wish to tweak the contents of the buffer after creation.
	117	*
	118	* Returns: length of buffer, or negative error code if something failed.
	119	*/
	120	int snd_pcm_create_iec958_consumer_hw_params(struct snd_pcm_hw_params *params,
	121	u8 *cs, size_t len)
	122	{
	123	return create_iec958_consumer(params_rate(params), params_width(params),
	124	cs, len);
	125	}
	126	EXPORT_SYMBOL(snd_pcm_create_iec958_consumer_hw_params);