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