plugins/tinyalsa/test/agmcompressplay.c - LeafOS-Project/android_vendor_qcom_opensource_agm - Gitiles

 /*
  * Copyright (c) 2019, 2021, The Linux Foundation. All rights reserved.
  * This code is used under the BSD license.
  *
  * BSD LICENSE
  *
  * Copyright (c) 2019, The Linux Foundation. All rights reserved.
  * Copyright (c) 2011-2012, Intel Corporation
  * All rights reserved.
  *
  * Author: Vinod Koul <vinod.koul@linux.intel.com>
  *
  * 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 Intel Corporation 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.
  *
  * LGPL LICENSE
  *
  * Copyright (c) 2011-2012, Intel Corporation.
  *
  * This program is free software; you can redistribute it and/or modify it
  * under the terms and conditions of the GNU Lesser General Public License,
  * version 2.1, as published by the Free Software Foundation.
  *
  * This program is distributed in the hope it will be useful, but WITHOUT
  * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
  * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU Lesser General Public
  * License for more details.
  *
  * You should have received a copy of the GNU Lesser General Public License
  * along with this program; if not, write to
  * the Free Software Foundation, Inc.,
  * 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
  */

 #include <stdint.h>
 #include <linux/types.h>
 #include <fcntl.h>
 #include <errno.h>
 #include <unistd.h>
 #include <stdio.h>
 #include <stdlib.h>
 #include <string.h>
 #include <signal.h>
 #include <stdbool.h>
 #include <getopt.h>
 #include <sys/time.h>
 #define __force
 //#define __bitwise
 #define __user
 #include <sound/compress_params.h>
 #include <tinycompress/tinycompress.h>

 #include "agmmixer.h"


 #define MP3_SYNC 0xe0ff

 const int mp3_sample_rates[3][3] = {
 	{44100, 48000, 32000},        /* MPEG-1 */
 	{22050, 24000, 16000},        /* MPEG-2 */
 	{11025, 12000,  8000},        /* MPEG-2.5 */
 };

 const int mp3_bit_rates[3][3][15] = {
 	{
 		/* MPEG-1 */
 		{  0, 32, 64, 96, 128, 160, 192, 224, 256, 288, 320, 352, 384, 416, 448}, /* Layer 1 */
 		{  0, 32, 48, 56, 64, 80, 96, 112, 128, 160, 192, 224, 256, 320, 384}, /* Layer 2 */
 		{  0, 32, 40, 48, 56, 64, 80, 96, 112, 128, 160, 192, 224, 256, 320}, /* Layer 3 */
 	},
 	{
 		/* MPEG-2 */
 		{  0, 32, 48, 56, 64, 80, 96, 112, 128, 144, 160, 176, 192, 224, 256}, /* Layer 1 */
 		{  0,  8, 16, 24, 32, 40, 48, 56, 64, 80, 96, 112, 128, 144, 160}, /* Layer 2 */
 		{  0,  8, 16, 24, 32, 40, 48, 56, 64, 80, 96, 112, 128, 144, 160}, /* Layer 3 */
 	},
 	{
 		/* MPEG-2.5 */
 		{  0, 32, 48, 56, 64, 80, 96, 112, 128, 144, 160, 176, 192, 224, 256}, /* Layer 1 */
 		{  0,  8, 16, 24, 32, 40, 48, 56, 64, 80, 96, 112, 128, 144, 160}, /* Layer 2 */
 		{  0,  8, 16, 24, 32, 40, 48, 56, 64, 80, 96, 112, 128, 144, 160}, /* Layer 3 */
 	},
 };

 enum mpeg_version {
 	MPEG1  = 0,
 	MPEG2  = 1,
 	MPEG25 = 2
 };

 enum mp3_stereo_mode {
 	STEREO = 0x00,
 	JOINT = 0x01,
 	DUAL = 0x02,
 	MONO = 0x03
 };

 static int verbose;

 static void usage(void)
 {
 	fprintf(stderr, "usage: cplay [OPTIONS] filename\n"
 		"-c\tcard number\n"
 		"-d\tdevice node\n"
 		"-b\tbuffer size\n"
 		"-f\tfragments\n\n"
                 "-i\taudio_intf_id\n"
 		"-v\tverbose mode\n"
 		"-h\tPrints this help list\n\n"
 		"-t\tcodec type\n\n"
 			"1 : mp3"
 			"2 : aac"
 		"-p\tpause/resume with 2 secs sleep\n\n"
 		"Example:\n"
 		"\tagmcompressplay -c 1 -d 2 test.mp3\n"
 		"\tagmcompressplay -f 5 test.mp3\n");

 	exit(EXIT_FAILURE);
 }

 void play_samples(char *name, unsigned int card, unsigned int device,
 		unsigned long buffer_size, unsigned int frag, unsigned int audio_format,
         int pause, struct device_config *dev_config);

 struct mp3_header {
 	uint16_t sync;
 	uint8_t format1;
 	uint8_t format2;
 };

 #define ADTS_SYNC 0xF0FF
 #define MP3_FORMAT 1
 #define AAC_ADTS_FORMAT 2

 struct adts_header {
 	uint32_t sync;
 	uint8_t format1;
 	uint8_t format2;
 	uint8_t format3;
 };

 uint aac_sample_rates[] = {96000, 88200, 64000, 48000, 44100, 32000, 24000, 22050, 16000, 12000, 11025, 8000, 7350, 48000, 48000, 48000};

 int parse_aac_header(struct adts_header *header, unsigned int *num_channels,
 		unsigned int *sample_rate, unsigned int *protection_absent)
 {
 	int profile, sample_rate_idx;

 	/* check sync bits */
 	if ((header->sync & 0xF0FF) != ADTS_SYNC) {
 		fprintf(stderr, "Error: Can't find sync word: 0x%X\n", header->sync);
 		return -1;
 	}
 	*protection_absent = (header->sync >> 8) & 0x01;
 	profile = ((header->sync >> 22) & 0x03) - 1;
 	sample_rate_idx = ((header->sync >> 18) & 0x0F);
 //	channel_idx = ((header->format1 >> 7) & 0x07);
 //	frame_length  = ((header->format1 >> 14) & 0x1FFF);

 	*num_channels = 2;
 	*sample_rate = aac_sample_rates[sample_rate_idx];
 //	 *size = frame_length - ((protection_absent == 1)? 7: 9));

 	if (verbose)
 		printf("%s: exit sr %d\n", __func__, *sample_rate);
 	return 0;
 }

 int parse_mp3_header(struct mp3_header *header, unsigned int *num_channels,
 		unsigned int *sample_rate, unsigned int *bit_rate)
 {
 	int ver_idx, mp3_version, layer, bit_rate_idx, sample_rate_idx, channel_idx;

 	/* check sync bits */
 	if ((header->sync & MP3_SYNC) != MP3_SYNC) {
 		fprintf(stderr, "Error: Can't find sync word\n");
 		return -1;
 	}
 	ver_idx = (header->sync >> 11) & 0x03;
 	mp3_version = ver_idx == 0 ? MPEG25 : ((ver_idx & 0x1) ? MPEG1 : MPEG2);
 	layer = 4 - ((header->sync >> 9) & 0x03);
 	bit_rate_idx = ((header->format1 >> 4) & 0x0f);
 	sample_rate_idx = ((header->format1 >> 2) & 0x03);
 	channel_idx = ((header->format2 >> 6) & 0x03);

 	if (sample_rate_idx == 3 || layer == 4 || bit_rate_idx == 15) {
 		fprintf(stderr, "Error: Can't find valid header\n");
 		return -1;
 	}
 	*num_channels = (channel_idx == MONO ? 1 : 2);
 	*sample_rate = mp3_sample_rates[mp3_version][sample_rate_idx];
 	*bit_rate = (mp3_bit_rates[mp3_version][layer - 1][bit_rate_idx]) * 1000;
 	if (verbose)
 		printf("%s: exit\n", __func__);
 	return 0;
 }

 int check_codec_format_supported(unsigned int card, unsigned int device, struct snd_codec *codec)
 {
 	if (is_codec_supported(card, device, COMPRESS_IN, codec) == false) {
 		fprintf(stderr, "Error: This codec or format is not supported by DSP\n");
 		return -1;
 	}
 	return 0;
 }

 static int print_time(struct compress *compress)
 {
 	unsigned int avail;
 	struct timespec tstamp;

 	if (compress_get_hpointer(compress, &avail, &tstamp) != 0) {
 		fprintf(stderr, "Error querying timestamp\n");
 		fprintf(stderr, "ERR: %s\n", compress_get_error(compress));
 		return -1;
 	} else
 		fprintf(stderr, "DSP played %ld.%ld\n", tstamp.tv_sec, tstamp.tv_nsec*1000);
 	return 0;
 }

 int main(int argc, char **argv)
 {
 	char *file;
 	unsigned long buffer_size = 0;
 	char *intf_name = NULL;
 	struct device_config config;
 	int ret = 0;
 	unsigned int card = 0, device = 0, frag = 0, audio_format = 0, pause = 0;


 	if (argc < 2)
 		usage();

 	file = argv[1];
 	/* parse command line arguments */
         argv += 2;
 	while (*argv) {
 		if (strcmp(*argv, "-d") == 0) {
 			argv++;
 			if (*argv)
 				device = atoi(*argv);
 		} else if (strcmp(*argv, "-t") == 0) {
 			argv++;
 			if (*argv)
 				audio_format = atoi(*argv);
 		} else if (strcmp(*argv, "-c") == 0) {
 			argv++;
 			if (*argv)
 				card = atoi(*argv);
 		} else if (strcmp(*argv, "-p") == 0) {
 			argv++;
 			if (*argv)
 				pause = atoi(*argv);
 		} else if (strcmp(*argv, "-i") == 0) {
 			argv++;
 			if (*argv)
 				intf_name = *argv;
 		}
 		if (*argv)
 			argv++;
 	}

 	if (intf_name == NULL)
 		return 1;

 	ret = get_device_media_config(BACKEND_CONF_FILE, intf_name, &config);
 	if (ret) {
 		printf("Invalid input, entry not found for : %s\n", intf_name);
 		return ret;
 	}

 	play_samples(file, card, device, buffer_size, frag, audio_format, pause, &config);

 	fprintf(stderr, "Finish Playing.... Close Normally\n");
 	exit(EXIT_SUCCESS);
 }

 void play_samples(char *name, unsigned int card, unsigned int device,
 		unsigned long buffer_size, unsigned int frag, unsigned int format,
         int pause, struct device_config *dev_config)
 {
 	struct compr_config config;
 	struct snd_codec codec;
 	struct compress *compress;
 	struct mp3_header header;
 	struct adts_header adts_header;
 	struct mixer *mixer;
 	FILE *file;
 	char *buffer;
 	int size, num_read, wrote;
 	unsigned int channels = 0, rate = 0, bits = 0;
 	char *intf_name = dev_config->name;

 	if (verbose)
 		printf("%s: entry\n", __func__);
 	file = fopen(name, "rb");
 	if (!file) {
 		fprintf(stderr, "Unable to open file '%s'\n", name);
 		exit(EXIT_FAILURE);
 	}

 	if (format == MP3_FORMAT) {
 		fread(&header, sizeof(header), 1, file);

 		if (parse_mp3_header(&header, &channels, &rate, &bits) == -1) {
 			fclose(file);
 			exit(EXIT_FAILURE);
 		}

 		codec.id = SND_AUDIOCODEC_MP3;
 #ifdef SND_COMPRESS_DEC_HDR
 	} else if (format == AAC_ADTS_FORMAT) {
 		uint16_t protection_absent, crc;
 		fread(&adts_header, sizeof(adts_header), 1, file);
 		if (parse_aac_header(&adts_header, &channels, &rate, (unsigned int*)&protection_absent) == -1) {
 			fclose(file);
 			exit(EXIT_FAILURE);
 		}
 		if (!protection_absent) {
 			fread(&crc, 2, 1, file);
 		}
 		codec.id = SND_AUDIOCODEC_AAC;
 		codec.format = SND_AUDIOSTREAMFORMAT_MP4ADTS;
 		bits = 16;
 		codec.options.aac_dec.audio_obj_type = 29;
 		codec.options.aac_dec.pce_bits_size = 0;
 #endif
 	} else {
 		printf("unknown format");
 	}
 	codec.ch_in = channels;
 	codec.ch_out = channels;
 	codec.sample_rate = rate;
 	if (!codec.sample_rate) {
 		fprintf(stderr, "invalid sample rate %d\n", rate);
 		fclose(file);
 		exit(EXIT_FAILURE);
 	}
 	codec.bit_rate = bits;
 	codec.rate_control = 0;
 	codec.profile = 0;
 	codec.level = 0;
 	codec.ch_mode = 0;
 	codec.format = 0;
 	if ((buffer_size != 0) && (frag != 0)) {
 		config.fragment_size = buffer_size/frag;
 		config.fragments = frag;
 	} else {
 		/* use driver defaults */
 		config.fragment_size = 0;
 		config.fragments = 0;
 	}
 	config.codec = &codec;

 	mixer = mixer_open(card);
 	if (!mixer) {
 		printf("Failed to open mixer\n");
 		goto FILE_EXIT;
 	}

 	/* set device/audio_intf media config mixer control */
 	if (set_agm_device_media_config(mixer, dev_config->ch, dev_config->rate,
                                     dev_config->bits, intf_name)) {
 		printf("Failed to set device media config\n");
 		goto MIXER_EXIT;
 	}

 	/* set audio interface metadata mixer control */
 	if (set_agm_audio_intf_metadata(mixer, intf_name, 0, PLAYBACK,
                                     dev_config->rate, dev_config->bits, COMPRESSED_OFFLOAD_PLAYBACK)) {
 		printf("Failed to set device metadata\n");
 		goto MIXER_EXIT;
 	}

 	/* set audio interface metadata mixer control */
 	if (set_agm_stream_metadata(mixer, device, COMPRESSED_OFFLOAD_PLAYBACK, PLAYBACK, STREAM_COMPRESS, NULL)) {
 		printf("Failed to set stream metadata\n");
 		goto MIXER_EXIT;
 	}

 	/* Note:  No common metadata as of now*/

 	/* connect stream to audio intf */
 	if (connect_agm_audio_intf_to_stream(mixer, device, intf_name, STREAM_COMPRESS, true)) {
 		printf("Failed to connect stream to audio interface\n");
 		goto MIXER_EXIT;
 	}

 	if (configure_mfc(mixer, device, intf_name, PER_STREAM_PER_DEVICE_MFC,
 			STREAM_COMPRESS, dev_config->rate, dev_config->ch,
 			dev_config->bits)) {
 		printf("Failed to configure pspd mfc\n");
 		goto MIXER_EXIT;
 	}

 	compress = compress_open(card, device, COMPRESS_IN, &config);
 	if (!compress || !is_compress_ready(compress)) {
 		fprintf(stderr, "Unable to open Compress device %d:%d\n",
 				card, device);
 		fprintf(stderr, "ERR: %s\n", compress_get_error(compress));
 		goto MIXER_EXIT;
 	};
 	if (verbose)
 		printf("%s: Opened compress device\n", __func__);
 	size = config.fragment_size;
 	buffer = malloc(size * config.fragments);
 	if (!buffer) {
 		fprintf(stderr, "Unable to allocate %d bytes\n", size);
 		goto COMP_EXIT;
 	}

 	/* we will write frag fragment_size and then start */
 	num_read = fread(buffer, 1, size * config.fragments, file);
 	if (num_read > 0) {
 		if (verbose)
 			printf("%s: Doing first buffer write of %d\n", __func__, num_read);
 		wrote = compress_write(compress, buffer, num_read);
 		if (wrote < 0) {
 			fprintf(stderr, "Error %d playing sample\n", wrote);
 			fprintf(stderr, "ERR: %s\n", compress_get_error(compress));
 			goto BUF_EXIT;
 		}
 		if (wrote != num_read) {
 			/* TODO: Buufer pointer needs to be set here */
 			fprintf(stderr, "We wrote %d, DSP accepted %d\n", num_read, wrote);
 		}
 	}
 	printf("Playing file %s On Card %u device %u, with buffer of %lu bytes\n",
 			name, card, device, buffer_size);
 	printf("Format %u Channels %u, %u Hz, Bit Rate %d\n",
 			SND_AUDIOCODEC_MP3, channels, rate, bits);

 	compress_start(compress);
 	if (verbose)
 		printf("%s: You should hear audio NOW!!!\n", __func__);

 	do {
 		num_read = fread(buffer, 1, size, file);
 		if (num_read > 0) {
 			wrote = compress_write(compress, buffer, num_read);
 			if (wrote < 0) {
 				fprintf(stderr, "Error playing sample\n");
 				fprintf(stderr, "ERR: %s\n", compress_get_error(compress));
 				goto BUF_EXIT;
 			}
 			if (wrote != num_read) {
 				/* TODO: Buffer pointer needs to be set here */
 				fprintf(stderr, "We wrote %d, DSP accepted %d\n", num_read, wrote);
 			}
 			if (verbose) {
 				print_time(compress);
 				printf("%s: wrote %d\n", __func__, wrote);
 			}
 			if (pause) {
 				printf("%s: pause \n", __func__);
 				compress_pause(compress);
 				sleep(2);
 				printf("%s: resume \n", __func__);
 				compress_resume(compress);
 			}
 		}
 	} while (num_read > 0);

 	if (verbose)
 		printf("%s: exit success\n", __func__);
 	/* issue drain if it supports */
 	compress_drain(compress);
 	/* disconnect stream to audio intf */
 	connect_agm_audio_intf_to_stream(mixer, device, intf_name, STREAM_COMPRESS, false);
 	free(buffer);
 	fclose(file);
 	compress_close(compress);
 	return;
 BUF_EXIT:
 	free(buffer);
 COMP_EXIT:
 	/* disconnect stream to audio intf */
 	connect_agm_audio_intf_to_stream(mixer, device, intf_name, STREAM_COMPRESS, false);
 	compress_close(compress);
 MIXER_EXIT:
 	mixer_close(mixer);
 FILE_EXIT:
 	fclose(file);
 	if (verbose)
 		printf("%s: exit failure\n", __func__);
 	exit(EXIT_FAILURE);
 }
	/*
	* Copyright (c) 2019, 2021, The Linux Foundation. All rights reserved.
	* This code is used under the BSD license.
	*
	* BSD LICENSE
	*
	* Copyright (c) 2019, The Linux Foundation. All rights reserved.
	* Copyright (c) 2011-2012, Intel Corporation
	* All rights reserved.
	*
	* Author: Vinod Koul <vinod.koul@linux.intel.com>
	*
	* 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 Intel Corporation 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.
	*
	* LGPL LICENSE
	*
	* Copyright (c) 2011-2012, Intel Corporation.
	*
	* This program is free software; you can redistribute it and/or modify it
	* under the terms and conditions of the GNU Lesser General Public License,
	* version 2.1, as published by the Free Software Foundation.
	*
	* This program is distributed in the hope it will be useful, but WITHOUT
	* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
	* FITNESS FOR A PARTICULAR PURPOSE. See the GNU Lesser General Public
	* License for more details.
	*
	* You should have received a copy of the GNU Lesser General Public License
	* along with this program; if not, write to
	* the Free Software Foundation, Inc.,
	* 51 Franklin St - Fifth Floor, Boston, MA 02110-1301 USA.
	*/

	#include <stdint.h>
	#include <linux/types.h>
	#include <fcntl.h>
	#include <errno.h>
	#include <unistd.h>
	#include <stdio.h>
	#include <stdlib.h>
	#include <string.h>
	#include <signal.h>
	#include <stdbool.h>
	#include <getopt.h>
	#include <sys/time.h>
	#define __force
	//#define __bitwise
	#define __user
	#include <sound/compress_params.h>
	#include <tinycompress/tinycompress.h>

	#include "agmmixer.h"


	#define MP3_SYNC 0xe0ff

	const int mp3_sample_rates[3][3] = {
	{44100, 48000, 32000}, /* MPEG-1 */
	{22050, 24000, 16000}, /* MPEG-2 */
	{11025, 12000, 8000}, /* MPEG-2.5 */
	};

	const int mp3_bit_rates[3][3][15] = {
	{
	/* MPEG-1 */
	{ 0, 32, 64, 96, 128, 160, 192, 224, 256, 288, 320, 352, 384, 416, 448}, /* Layer 1 */
	{ 0, 32, 48, 56, 64, 80, 96, 112, 128, 160, 192, 224, 256, 320, 384}, /* Layer 2 */
	{ 0, 32, 40, 48, 56, 64, 80, 96, 112, 128, 160, 192, 224, 256, 320}, /* Layer 3 */
	},
	{
	/* MPEG-2 */
	{ 0, 32, 48, 56, 64, 80, 96, 112, 128, 144, 160, 176, 192, 224, 256}, /* Layer 1 */
	{ 0, 8, 16, 24, 32, 40, 48, 56, 64, 80, 96, 112, 128, 144, 160}, /* Layer 2 */
	{ 0, 8, 16, 24, 32, 40, 48, 56, 64, 80, 96, 112, 128, 144, 160}, /* Layer 3 */
	},
	{
	/* MPEG-2.5 */
	{ 0, 32, 48, 56, 64, 80, 96, 112, 128, 144, 160, 176, 192, 224, 256}, /* Layer 1 */
	{ 0, 8, 16, 24, 32, 40, 48, 56, 64, 80, 96, 112, 128, 144, 160}, /* Layer 2 */
	{ 0, 8, 16, 24, 32, 40, 48, 56, 64, 80, 96, 112, 128, 144, 160}, /* Layer 3 */
	},
	};

	enum mpeg_version {
	MPEG1 = 0,
	MPEG2 = 1,
	MPEG25 = 2
	};

	enum mp3_stereo_mode {
	STEREO = 0x00,
	JOINT = 0x01,
	DUAL = 0x02,
	MONO = 0x03
	};

	static int verbose;

	static void usage(void)
	{
	fprintf(stderr, "usage: cplay [OPTIONS] filename\n"
	"-c\tcard number\n"
	"-d\tdevice node\n"
	"-b\tbuffer size\n"
	"-f\tfragments\n\n"
	"-i\taudio_intf_id\n"
	"-v\tverbose mode\n"
	"-h\tPrints this help list\n\n"
	"-t\tcodec type\n\n"
	"1 : mp3"
	"2 : aac"
	"-p\tpause/resume with 2 secs sleep\n\n"
	"Example:\n"
	"\tagmcompressplay -c 1 -d 2 test.mp3\n"
	"\tagmcompressplay -f 5 test.mp3\n");

	exit(EXIT_FAILURE);
	}

	void play_samples(char *name, unsigned int card, unsigned int device,
	unsigned long buffer_size, unsigned int frag, unsigned int audio_format,
	int pause, struct device_config *dev_config);

	struct mp3_header {
	uint16_t sync;
	uint8_t format1;
	uint8_t format2;
	};

	#define ADTS_SYNC 0xF0FF
	#define MP3_FORMAT 1
	#define AAC_ADTS_FORMAT 2

	struct adts_header {
	uint32_t sync;
	uint8_t format1;
	uint8_t format2;
	uint8_t format3;
	};

	uint aac_sample_rates[] = {96000, 88200, 64000, 48000, 44100, 32000, 24000, 22050, 16000, 12000, 11025, 8000, 7350, 48000, 48000, 48000};

	int parse_aac_header(struct adts_header header, unsigned int num_channels,
	unsigned int sample_rate, unsigned int protection_absent)
	{
	int profile, sample_rate_idx;

	/* check sync bits */
	if ((header->sync & 0xF0FF) != ADTS_SYNC) {
	fprintf(stderr, "Error: Can't find sync word: 0x%X\n", header->sync);
	return -1;
	}
	*protection_absent = (header->sync >> 8) & 0x01;
	profile = ((header->sync >> 22) & 0x03) - 1;
	sample_rate_idx = ((header->sync >> 18) & 0x0F);
	// channel_idx = ((header->format1 >> 7) & 0x07);
	// frame_length = ((header->format1 >> 14) & 0x1FFF);

	*num_channels = 2;
	*sample_rate = aac_sample_rates[sample_rate_idx];
	// *size = frame_length - ((protection_absent == 1)? 7: 9));

	if (verbose)
	printf("%s: exit sr %d\n", __func__, *sample_rate);
	return 0;
	}

	int parse_mp3_header(struct mp3_header header, unsigned int num_channels,
	unsigned int sample_rate, unsigned int bit_rate)
	{
	int ver_idx, mp3_version, layer, bit_rate_idx, sample_rate_idx, channel_idx;

	/* check sync bits */
	if ((header->sync & MP3_SYNC) != MP3_SYNC) {
	fprintf(stderr, "Error: Can't find sync word\n");
	return -1;
	}
	ver_idx = (header->sync >> 11) & 0x03;
	mp3_version = ver_idx == 0 ? MPEG25 : ((ver_idx & 0x1) ? MPEG1 : MPEG2);
	layer = 4 - ((header->sync >> 9) & 0x03);
	bit_rate_idx = ((header->format1 >> 4) & 0x0f);
	sample_rate_idx = ((header->format1 >> 2) & 0x03);
	channel_idx = ((header->format2 >> 6) & 0x03);

	if (sample_rate_idx == 3 \|\| layer == 4 \|\| bit_rate_idx == 15) {
	fprintf(stderr, "Error: Can't find valid header\n");
	return -1;
	}
	*num_channels = (channel_idx == MONO ? 1 : 2);
	*sample_rate = mp3_sample_rates[mp3_version][sample_rate_idx];
	bit_rate = (mp3_bit_rates[mp3_version][layer - 1][bit_rate_idx]) 1000;
	if (verbose)
	printf("%s: exit\n", __func__);
	return 0;
	}

	int check_codec_format_supported(unsigned int card, unsigned int device, struct snd_codec *codec)
	{
	if (is_codec_supported(card, device, COMPRESS_IN, codec) == false) {
	fprintf(stderr, "Error: This codec or format is not supported by DSP\n");
	return -1;
	}
	return 0;
	}

	static int print_time(struct compress *compress)
	{
	unsigned int avail;
	struct timespec tstamp;

	if (compress_get_hpointer(compress, &avail, &tstamp) != 0) {
	fprintf(stderr, "Error querying timestamp\n");
	fprintf(stderr, "ERR: %s\n", compress_get_error(compress));
	return -1;
	} else
	fprintf(stderr, "DSP played %ld.%ld\n", tstamp.tv_sec, tstamp.tv_nsec*1000);
	return 0;
	}

	int main(int argc, char **argv)
	{
	char *file;
	unsigned long buffer_size = 0;
	char *intf_name = NULL;
	struct device_config config;
	int ret = 0;
	unsigned int card = 0, device = 0, frag = 0, audio_format = 0, pause = 0;


	if (argc < 2)
	usage();

	file = argv[1];
	/* parse command line arguments */
	argv += 2;
	while (*argv) {
	if (strcmp(*argv, "-d") == 0) {
	argv++;
	if (*argv)
	device = atoi(*argv);
	} else if (strcmp(*argv, "-t") == 0) {
	argv++;
	if (*argv)
	audio_format = atoi(*argv);
	} else if (strcmp(*argv, "-c") == 0) {
	argv++;
	if (*argv)
	card = atoi(*argv);
	} else if (strcmp(*argv, "-p") == 0) {
	argv++;
	if (*argv)
	pause = atoi(*argv);
	} else if (strcmp(*argv, "-i") == 0) {
	argv++;
	if (*argv)
	intf_name = *argv;
	}
	if (*argv)
	argv++;
	}

	if (intf_name == NULL)
	return 1;

	ret = get_device_media_config(BACKEND_CONF_FILE, intf_name, &config);
	if (ret) {
	printf("Invalid input, entry not found for : %s\n", intf_name);
	return ret;
	}

	play_samples(file, card, device, buffer_size, frag, audio_format, pause, &config);

	fprintf(stderr, "Finish Playing.... Close Normally\n");
	exit(EXIT_SUCCESS);
	}

	void play_samples(char *name, unsigned int card, unsigned int device,
	unsigned long buffer_size, unsigned int frag, unsigned int format,
	int pause, struct device_config *dev_config)
	{
	struct compr_config config;
	struct snd_codec codec;
	struct compress *compress;
	struct mp3_header header;
	struct adts_header adts_header;
	struct mixer *mixer;
	FILE *file;
	char *buffer;
	int size, num_read, wrote;
	unsigned int channels = 0, rate = 0, bits = 0;
	char *intf_name = dev_config->name;

	if (verbose)
	printf("%s: entry\n", __func__);
	file = fopen(name, "rb");
	if (!file) {
	fprintf(stderr, "Unable to open file '%s'\n", name);
	exit(EXIT_FAILURE);
	}

	if (format == MP3_FORMAT) {
	fread(&header, sizeof(header), 1, file);

	if (parse_mp3_header(&header, &channels, &rate, &bits) == -1) {
	fclose(file);
	exit(EXIT_FAILURE);
	}

	codec.id = SND_AUDIOCODEC_MP3;
	#ifdef SND_COMPRESS_DEC_HDR
	} else if (format == AAC_ADTS_FORMAT) {
	uint16_t protection_absent, crc;
	fread(&adts_header, sizeof(adts_header), 1, file);
	if (parse_aac_header(&adts_header, &channels, &rate, (unsigned int*)&protection_absent) == -1) {
	fclose(file);
	exit(EXIT_FAILURE);
	}
	if (!protection_absent) {
	fread(&crc, 2, 1, file);
	}
	codec.id = SND_AUDIOCODEC_AAC;
	codec.format = SND_AUDIOSTREAMFORMAT_MP4ADTS;
	bits = 16;
	codec.options.aac_dec.audio_obj_type = 29;
	codec.options.aac_dec.pce_bits_size = 0;
	#endif
	} else {
	printf("unknown format");
	}
	codec.ch_in = channels;
	codec.ch_out = channels;
	codec.sample_rate = rate;
	if (!codec.sample_rate) {
	fprintf(stderr, "invalid sample rate %d\n", rate);
	fclose(file);
	exit(EXIT_FAILURE);
	}
	codec.bit_rate = bits;
	codec.rate_control = 0;
	codec.profile = 0;
	codec.level = 0;
	codec.ch_mode = 0;
	codec.format = 0;
	if ((buffer_size != 0) && (frag != 0)) {
	config.fragment_size = buffer_size/frag;
	config.fragments = frag;
	} else {
	/* use driver defaults */
	config.fragment_size = 0;
	config.fragments = 0;
	}
	config.codec = &codec;

	mixer = mixer_open(card);
	if (!mixer) {
	printf("Failed to open mixer\n");
	goto FILE_EXIT;
	}

	/* set device/audio_intf media config mixer control */
	if (set_agm_device_media_config(mixer, dev_config->ch, dev_config->rate,
	dev_config->bits, intf_name)) {
	printf("Failed to set device media config\n");
	goto MIXER_EXIT;
	}

	/* set audio interface metadata mixer control */
	if (set_agm_audio_intf_metadata(mixer, intf_name, 0, PLAYBACK,
	dev_config->rate, dev_config->bits, COMPRESSED_OFFLOAD_PLAYBACK)) {
	printf("Failed to set device metadata\n");
	goto MIXER_EXIT;
	}

	/* set audio interface metadata mixer control */
	if (set_agm_stream_metadata(mixer, device, COMPRESSED_OFFLOAD_PLAYBACK, PLAYBACK, STREAM_COMPRESS, NULL)) {
	printf("Failed to set stream metadata\n");
	goto MIXER_EXIT;
	}

	/* Note: No common metadata as of now*/

	/* connect stream to audio intf */
	if (connect_agm_audio_intf_to_stream(mixer, device, intf_name, STREAM_COMPRESS, true)) {
	printf("Failed to connect stream to audio interface\n");
	goto MIXER_EXIT;
	}

	if (configure_mfc(mixer, device, intf_name, PER_STREAM_PER_DEVICE_MFC,
	STREAM_COMPRESS, dev_config->rate, dev_config->ch,
	dev_config->bits)) {
	printf("Failed to configure pspd mfc\n");
	goto MIXER_EXIT;
	}

	compress = compress_open(card, device, COMPRESS_IN, &config);
	if (!compress \|\| !is_compress_ready(compress)) {
	fprintf(stderr, "Unable to open Compress device %d:%d\n",
	card, device);
	fprintf(stderr, "ERR: %s\n", compress_get_error(compress));
	goto MIXER_EXIT;
	};
	if (verbose)
	printf("%s: Opened compress device\n", __func__);
	size = config.fragment_size;
	buffer = malloc(size * config.fragments);
	if (!buffer) {
	fprintf(stderr, "Unable to allocate %d bytes\n", size);
	goto COMP_EXIT;
	}

	/* we will write frag fragment_size and then start */
	num_read = fread(buffer, 1, size * config.fragments, file);
	if (num_read > 0) {
	if (verbose)
	printf("%s: Doing first buffer write of %d\n", __func__, num_read);
	wrote = compress_write(compress, buffer, num_read);
	if (wrote < 0) {
	fprintf(stderr, "Error %d playing sample\n", wrote);
	fprintf(stderr, "ERR: %s\n", compress_get_error(compress));
	goto BUF_EXIT;
	}
	if (wrote != num_read) {
	/* TODO: Buufer pointer needs to be set here */
	fprintf(stderr, "We wrote %d, DSP accepted %d\n", num_read, wrote);
	}
	}
	printf("Playing file %s On Card %u device %u, with buffer of %lu bytes\n",
	name, card, device, buffer_size);
	printf("Format %u Channels %u, %u Hz, Bit Rate %d\n",
	SND_AUDIOCODEC_MP3, channels, rate, bits);

	compress_start(compress);
	if (verbose)
	printf("%s: You should hear audio NOW!!!\n", __func__);

	do {
	num_read = fread(buffer, 1, size, file);
	if (num_read > 0) {
	wrote = compress_write(compress, buffer, num_read);
	if (wrote < 0) {
	fprintf(stderr, "Error playing sample\n");
	fprintf(stderr, "ERR: %s\n", compress_get_error(compress));
	goto BUF_EXIT;
	}
	if (wrote != num_read) {
	/* TODO: Buffer pointer needs to be set here */
	fprintf(stderr, "We wrote %d, DSP accepted %d\n", num_read, wrote);
	}
	if (verbose) {
	print_time(compress);
	printf("%s: wrote %d\n", __func__, wrote);
	}
	if (pause) {
	printf("%s: pause \n", __func__);
	compress_pause(compress);
	sleep(2);
	printf("%s: resume \n", __func__);
	compress_resume(compress);
	}
	}
	} while (num_read > 0);

	if (verbose)
	printf("%s: exit success\n", __func__);
	/* issue drain if it supports */
	compress_drain(compress);
	/* disconnect stream to audio intf */
	connect_agm_audio_intf_to_stream(mixer, device, intf_name, STREAM_COMPRESS, false);
	free(buffer);
	fclose(file);
	compress_close(compress);
	return;
	BUF_EXIT:
	free(buffer);
	COMP_EXIT:
	/* disconnect stream to audio intf */
	connect_agm_audio_intf_to_stream(mixer, device, intf_name, STREAM_COMPRESS, false);
	compress_close(compress);
	MIXER_EXIT:
	mixer_close(mixer);
	FILE_EXIT:
	fclose(file);
	if (verbose)
	printf("%s: exit failure\n", __func__);
	exit(EXIT_FAILURE);
	}