Home | History | Annotate | Line # | Download | only in audio
      1 /*	$NetBSD: h_pad.c,v 1.3 2019/06/20 12:14:46 isaki Exp $	*/
      2 
      3 /*
      4  * Copyright (c) 2010 Antti Kantee.  All Rights Reserved.
      5  *
      6  * Redistribution and use in source and binary forms, with or without
      7  * modification, are permitted provided that the following conditions
      8  * are met:
      9  * 1. Redistributions of source code must retain the above copyright
     10  *    notice, this list of conditions and the following disclaimer.
     11  * 2. Redistributions in binary form must reproduce the above copyright
     12  *    notice, this list of conditions and the following disclaimer in the
     13  *    documentation and/or other materials provided with the distribution.
     14  *
     15  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS
     16  * OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
     17  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
     18  * DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
     19  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     20  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
     21  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     22  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     23  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     24  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     25  * SUCH DAMAGE.
     26  */
     27 
     28 #include <sys/types.h>
     29 
     30 #include <rump/rump.h>
     31 #include <rump/rump_syscalls.h>
     32 
     33 #include <err.h>
     34 #include <fcntl.h>
     35 #include <stdbool.h>
     36 #include <stdio.h>
     37 #include <stdlib.h>
     38 #include <string.h>
     39 #include <unistd.h>
     40 #include <sys/audioio.h>
     41 
     42 #include "h_pad_musa.c"
     43 
     44 /*
     45  * Stuff some audio into /dev/audio, read it from /dev/pad.
     46  */
     47 
     48 #define BUFSIZE 1024
     49 
     50 static const int16_t mulaw_to_slinear16[256] = {
     51 	0x8284, 0x8684, 0x8a84, 0x8e84, 0x9284, 0x9684, 0x9a84, 0x9e84,
     52 	0xa284, 0xa684, 0xaa84, 0xae84, 0xb284, 0xb684, 0xba84, 0xbe84,
     53 	0xc184, 0xc384, 0xc584, 0xc784, 0xc984, 0xcb84, 0xcd84, 0xcf84,
     54 	0xd184, 0xd384, 0xd584, 0xd784, 0xd984, 0xdb84, 0xdd84, 0xdf84,
     55 	0xe104, 0xe204, 0xe304, 0xe404, 0xe504, 0xe604, 0xe704, 0xe804,
     56 	0xe904, 0xea04, 0xeb04, 0xec04, 0xed04, 0xee04, 0xef04, 0xf004,
     57 	0xf0c4, 0xf144, 0xf1c4, 0xf244, 0xf2c4, 0xf344, 0xf3c4, 0xf444,
     58 	0xf4c4, 0xf544, 0xf5c4, 0xf644, 0xf6c4, 0xf744, 0xf7c4, 0xf844,
     59 	0xf8a4, 0xf8e4, 0xf924, 0xf964, 0xf9a4, 0xf9e4, 0xfa24, 0xfa64,
     60 	0xfaa4, 0xfae4, 0xfb24, 0xfb64, 0xfba4, 0xfbe4, 0xfc24, 0xfc64,
     61 	0xfc94, 0xfcb4, 0xfcd4, 0xfcf4, 0xfd14, 0xfd34, 0xfd54, 0xfd74,
     62 	0xfd94, 0xfdb4, 0xfdd4, 0xfdf4, 0xfe14, 0xfe34, 0xfe54, 0xfe74,
     63 	0xfe8c, 0xfe9c, 0xfeac, 0xfebc, 0xfecc, 0xfedc, 0xfeec, 0xfefc,
     64 	0xff0c, 0xff1c, 0xff2c, 0xff3c, 0xff4c, 0xff5c, 0xff6c, 0xff7c,
     65 	0xff88, 0xff90, 0xff98, 0xffa0, 0xffa8, 0xffb0, 0xffb8, 0xffc0,
     66 	0xffc8, 0xffd0, 0xffd8, 0xffe0, 0xffe8, 0xfff0, 0xfff8, 0xfffc,
     67 	0x7d7c, 0x797c, 0x757c, 0x717c, 0x6d7c, 0x697c, 0x657c, 0x617c,
     68 	0x5d7c, 0x597c, 0x557c, 0x517c, 0x4d7c, 0x497c, 0x457c, 0x417c,
     69 	0x3e7c, 0x3c7c, 0x3a7c, 0x387c, 0x367c, 0x347c, 0x327c, 0x307c,
     70 	0x2e7c, 0x2c7c, 0x2a7c, 0x287c, 0x267c, 0x247c, 0x227c, 0x207c,
     71 	0x1efc, 0x1dfc, 0x1cfc, 0x1bfc, 0x1afc, 0x19fc, 0x18fc, 0x17fc,
     72 	0x16fc, 0x15fc, 0x14fc, 0x13fc, 0x12fc, 0x11fc, 0x10fc, 0x0ffc,
     73 	0x0f3c, 0x0ebc, 0x0e3c, 0x0dbc, 0x0d3c, 0x0cbc, 0x0c3c, 0x0bbc,
     74 	0x0b3c, 0x0abc, 0x0a3c, 0x09bc, 0x093c, 0x08bc, 0x083c, 0x07bc,
     75 	0x075c, 0x071c, 0x06dc, 0x069c, 0x065c, 0x061c, 0x05dc, 0x059c,
     76 	0x055c, 0x051c, 0x04dc, 0x049c, 0x045c, 0x041c, 0x03dc, 0x039c,
     77 	0x036c, 0x034c, 0x032c, 0x030c, 0x02ec, 0x02cc, 0x02ac, 0x028c,
     78 	0x026c, 0x024c, 0x022c, 0x020c, 0x01ec, 0x01cc, 0x01ac, 0x018c,
     79 	0x0174, 0x0164, 0x0154, 0x0144, 0x0134, 0x0124, 0x0114, 0x0104,
     80 	0x00f4, 0x00e4, 0x00d4, 0x00c4, 0x00b4, 0x00a4, 0x0094, 0x0084,
     81 	0x0078, 0x0070, 0x0068, 0x0060, 0x0058, 0x0050, 0x0048, 0x0040,
     82 	0x0038, 0x0030, 0x0028, 0x0020, 0x0018, 0x0010, 0x0008, 0x0000,
     83 };
     84 
     85 #define DPRINTF(n, fmt...)	do { \
     86 	if (debug >= (n)) \
     87 		printf(fmt);	\
     88 } while (0)
     89 
     90 int debug;
     91 
     92 int
     93 main(int argc, char *argv[])
     94 {
     95 	struct audio_info ai;
     96 	int padfd, audiofd;
     97 	ssize_t n;
     98 	int i;
     99 	int nframe;
    100 	int outlen;
    101 	uint32_t *outbuf;
    102 	uint32_t *outp;
    103 	int inplen;
    104 	uint32_t *inpbuf;
    105 	uint32_t actual;
    106 	uint32_t expected;
    107 	int c;
    108 	enum {
    109 		PRE,
    110 		BODY,
    111 		POST,
    112 	} phase;
    113 
    114 	while ((c = getopt(argc, argv, "d")) != -1) {
    115 		switch (c) {
    116 		case 'd':
    117 			debug++;
    118 			break;
    119 		default:
    120 			errx(1, "unknown option");
    121 		}
    122 	}
    123 
    124 	/* Make input buffer (and it is also expected data). */
    125 	inplen = sizeof(musa) * 4;
    126 	inpbuf = (uint32_t *)malloc(inplen);
    127 	if (inpbuf == NULL)
    128 		err(1, "malloc: inpbuf");
    129 
    130 	/* mulaw:mono to slinear_le16:stereo */
    131 	for (i = 0; i < (int)sizeof(musa); i++) {
    132 		int16_t s = mulaw_to_slinear16[musa[i]];
    133 		uint32_t v = htole16((uint16_t)s);
    134 		inpbuf[i] = (v << 16) | v;
    135 	}
    136 
    137 	outlen = BUFSIZE;
    138 	outbuf = (uint32_t *)malloc(outlen);
    139 	if (outbuf == NULL)
    140 		err(1, "malloc: outbuf");
    141 
    142 	DPRINTF(1, "init\n");
    143 	rump_init();
    144 	padfd = rump_sys_open("/dev/pad0", O_RDONLY);
    145 	if (padfd == -1)
    146 		err(1, "open pad");
    147 
    148 	audiofd = rump_sys_open("/dev/audio0", O_RDWR);
    149 	if (audiofd == -1)
    150 		err(1, "open audio");
    151 
    152 	DPRINTF(1, "ioctl\n");
    153 	/* pad is SLINEAR_LE, 16bit, 2ch, 44100Hz. */
    154 	AUDIO_INITINFO(&ai);
    155 	ai.play.encoding = AUDIO_ENCODING_SLINEAR_LE;
    156 	ai.play.precision = 16;
    157 	ai.play.channels = 2;
    158 	ai.play.sample_rate = 44100;
    159 	n = rump_sys_ioctl(audiofd, AUDIO_SETINFO, &ai);
    160 	if (n == -1)
    161 		err(1, "ioctl");
    162 
    163 	DPRINTF(1, "write %d\n", inplen);
    164 	n = rump_sys_write(audiofd, inpbuf, inplen);
    165 	if (n == -1)
    166 		err(1, "write");
    167 	if (n != inplen)
    168 		errx(1, "write: n=%zd < %d", n, inplen);
    169 
    170 	phase = PRE;
    171 	i = 0;
    172 	nframe = 0;
    173 	outp = NULL;
    174 	for (;;) {
    175 		/* Read to outbuf when it is empty. */
    176 		if (nframe == 0) {
    177 			n = rump_sys_read(padfd, outbuf, outlen);
    178 			if (n == -1)
    179 				err(1, "read");
    180 			if (n == 0)
    181 				errx(1, "read: EOF");
    182 			/* XXX Should I recover from this? */
    183 			if (n % 4 != 0)
    184 				errx(1, "read: n=%zd", n);
    185 
    186 			nframe = n / 4;
    187 			outp = outbuf;
    188 		}
    189 
    190 		if (phase == PRE) {
    191 			/* Skip preceding silence part. */
    192 			if (*outp == 0) {
    193 				outp++;
    194 				nframe--;
    195 			} else {
    196 				/* This is the first frame. */
    197 				phase = BODY;
    198 			}
    199 		} else if (phase == BODY) {
    200 			/* Compare wavedata. */
    201 			expected = le32dec(outp);
    202 			actual = le32dec(inpbuf + i);
    203 			DPRINTF(2, "[%d] %08x %08x\n", i, actual, expected);
    204 			if (actual != expected) {
    205 				errx(1, "bad output [%d] %08x %08x",
    206 				    i, actual, expected);
    207 			}
    208 			outp++;
    209 			nframe--;
    210 			i++;
    211 			if (i >= (int)sizeof(musa)) {
    212 				phase = POST;
    213 				i = 0;
    214 			}
    215 		} else if (phase == POST) {
    216 			/*
    217 			 * There is no way to determine the end of playback.
    218 			 * Therefore it detects and terminates with some
    219 			 * continuous silence.
    220 			 */
    221 			actual = le32dec(outp);
    222 			if (actual != 0)
    223 				errx(1, "bad post output: %08x", actual);
    224 			outp++;
    225 			nframe--;
    226 			i++;
    227 			if (i >= (int)ai.play.sample_rate / 100)
    228 				break;
    229 		}
    230 	}
    231 	DPRINTF(1, "success\n");
    232 	return 0;
    233 }
    234