1 1.2 tsutsui /* $NetBSD: psgpam.c,v 1.2 2022/06/11 14:45:37 tsutsui Exp $ */ 2 1.1 tsutsui 3 1.1 tsutsui /* 4 1.1 tsutsui * Copyright (c) 2018 Yosuke Sugahara. All rights reserved. 5 1.1 tsutsui * 6 1.1 tsutsui * Redistribution and use in source and binary forms, with or without 7 1.1 tsutsui * modification, are permitted provided that the following conditions 8 1.1 tsutsui * are met: 9 1.1 tsutsui * 1. Redistributions of source code must retain the above copyright 10 1.1 tsutsui * notice, this list of conditions and the following disclaimer. 11 1.1 tsutsui * 2. Redistributions in binary form must reproduce the above copyright 12 1.1 tsutsui * notice, this list of conditions and the following disclaimer in the 13 1.1 tsutsui * documentation and/or other materials provided with the distribution. 14 1.1 tsutsui * 15 1.1 tsutsui * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 16 1.1 tsutsui * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 17 1.1 tsutsui * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 18 1.1 tsutsui * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 19 1.1 tsutsui * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 20 1.1 tsutsui * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 21 1.1 tsutsui * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 22 1.1 tsutsui * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 23 1.1 tsutsui * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 24 1.1 tsutsui * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 25 1.1 tsutsui * SUCH DAMAGE. 26 1.1 tsutsui */ 27 1.1 tsutsui 28 1.1 tsutsui #include <sys/cdefs.h> 29 1.2 tsutsui __KERNEL_RCSID(0, "$NetBSD: psgpam.c,v 1.2 2022/06/11 14:45:37 tsutsui Exp $"); 30 1.1 tsutsui 31 1.1 tsutsui #include <sys/param.h> 32 1.1 tsutsui #include <sys/systm.h> 33 1.1 tsutsui #include <sys/device.h> 34 1.1 tsutsui #include <sys/endian.h> 35 1.1 tsutsui #include <sys/kmem.h> 36 1.1 tsutsui #include <sys/sysctl.h> 37 1.1 tsutsui 38 1.1 tsutsui #include <sys/cpu.h> 39 1.1 tsutsui #include <sys/audioio.h> 40 1.1 tsutsui #include <dev/audio/audio_if.h> 41 1.1 tsutsui 42 1.1 tsutsui #include <machine/autoconf.h> 43 1.1 tsutsui 44 1.1 tsutsui #include <luna68k/dev/xpbusvar.h> 45 1.1 tsutsui #include <luna68k/dev/psgpam_enc.h> 46 1.1 tsutsui #include <luna68k/dev/xpcmd.h> 47 1.1 tsutsui #include <luna68k/dev/xplx/xplxdefs.h> 48 1.1 tsutsui 49 1.1 tsutsui #include <luna68k/luna68k/isr.h> 50 1.1 tsutsui 51 1.1 tsutsui #include "ioconf.h" 52 1.1 tsutsui 53 1.1 tsutsui /* 54 1.1 tsutsui * Debug level: 55 1.1 tsutsui * 0: No debug logs 56 1.1 tsutsui * 1: action changes like open/close/set_format... 57 1.1 tsutsui * 2: + normal operations like read/write/ioctl... 58 1.1 tsutsui * 3: + TRACEs except interrupt 59 1.1 tsutsui * 4: + TRACEs including interrupt 60 1.1 tsutsui */ 61 1.1 tsutsui /* Note AUDIO_DEBUG should be sync'ed with src/sys/dev/audio/audio.c */ 62 1.1 tsutsui /* #define AUDIO_DEBUG 1 */ 63 1.1 tsutsui 64 1.1 tsutsui #if defined(AUDIO_DEBUG) 65 1.1 tsutsui #define DPRINTF(n, fmt...) do { \ 66 1.1 tsutsui if (psgpamdebug >= (n)) { \ 67 1.1 tsutsui if (cpu_intr_p()) { \ 68 1.1 tsutsui audio_mlog_printf(fmt); \ 69 1.1 tsutsui } else { \ 70 1.1 tsutsui audio_mlog_flush(); \ 71 1.1 tsutsui printf(fmt); \ 72 1.1 tsutsui } \ 73 1.1 tsutsui } \ 74 1.1 tsutsui } while (0) 75 1.1 tsutsui 76 1.1 tsutsui /* XXX Parasitic to audio.c... */ 77 1.1 tsutsui extern void audio_mlog_flush(void); 78 1.1 tsutsui extern void audio_mlog_printf(const char *, ...); 79 1.1 tsutsui 80 1.1 tsutsui static int psgpamdebug = AUDIO_DEBUG; 81 1.1 tsutsui #else 82 1.1 tsutsui #define DPRINTF(n, fmt...) __nothing 83 1.1 tsutsui #endif 84 1.1 tsutsui 85 1.1 tsutsui struct psgpam_softc { 86 1.1 tsutsui device_t sc_dev; 87 1.1 tsutsui vaddr_t sc_shm_base; 88 1.1 tsutsui vsize_t sc_shm_size; 89 1.1 tsutsui 90 1.1 tsutsui void (*sc_intr)(void *); 91 1.1 tsutsui void *sc_arg; 92 1.1 tsutsui 93 1.1 tsutsui kmutex_t sc_intr_lock; 94 1.1 tsutsui kmutex_t sc_thread_lock; 95 1.1 tsutsui 96 1.1 tsutsui int sc_isopen; 97 1.1 tsutsui 98 1.1 tsutsui int sc_started; 99 1.1 tsutsui int sc_outcount; 100 1.1 tsutsui int sc_xp_state; 101 1.1 tsutsui uint16_t sc_xp_addr; /* XP buffer addr */ 102 1.1 tsutsui 103 1.1 tsutsui int sc_xp_enc; 104 1.1 tsutsui int sc_xp_rept; 105 1.1 tsutsui int sc_xp_cycle_clk; 106 1.1 tsutsui int sc_xp_rept_clk; 107 1.1 tsutsui int sc_xp_rept_max; 108 1.1 tsutsui 109 1.1 tsutsui u_int sc_sample_rate; 110 1.1 tsutsui int sc_stride; 111 1.1 tsutsui int sc_dynamic; 112 1.1 tsutsui 113 1.1 tsutsui uint8_t *sc_start_ptr; 114 1.1 tsutsui uint8_t *sc_end_ptr; 115 1.1 tsutsui int sc_blksize; 116 1.1 tsutsui int sc_blkcount; 117 1.1 tsutsui int sc_cur_blk_id; 118 1.1 tsutsui 119 1.1 tsutsui struct psgpam_codecvar sc_psgpam_codecvar; 120 1.1 tsutsui }; 121 1.1 tsutsui 122 1.1 tsutsui static int psgpam_match(device_t, cfdata_t, void *); 123 1.1 tsutsui static void psgpam_attach(device_t, device_t, void *); 124 1.1 tsutsui 125 1.1 tsutsui /* MI audio layer interface */ 126 1.1 tsutsui static int psgpam_open(void *, int); 127 1.1 tsutsui static void psgpam_close(void *); 128 1.1 tsutsui static int psgpam_query_format(void *, audio_format_query_t *); 129 1.1 tsutsui static int psgpam_set_format(void *, int, 130 1.1 tsutsui const audio_params_t *, const audio_params_t *, 131 1.1 tsutsui audio_filter_reg_t *, audio_filter_reg_t *); 132 1.1 tsutsui static int psgpam_trigger_output(void *, void *, void *, int, 133 1.1 tsutsui void (*)(void *), void *, const audio_params_t *); 134 1.1 tsutsui static int psgpam_halt_output(void *); 135 1.1 tsutsui static int psgpam_getdev(void *, struct audio_device *); 136 1.1 tsutsui static int psgpam_set_port(void *, mixer_ctrl_t *); 137 1.1 tsutsui static int psgpam_get_port(void *, mixer_ctrl_t *); 138 1.1 tsutsui static int psgpam_query_devinfo(void *, mixer_devinfo_t *); 139 1.1 tsutsui static int psgpam_get_props(void *); 140 1.1 tsutsui static void psgpam_get_locks(void *, kmutex_t **, kmutex_t **); 141 1.1 tsutsui static int psgpam_round_blocksize(void *, int, int, const audio_params_t *); 142 1.1 tsutsui static size_t psgpam_round_buffersize(void *, int, size_t); 143 1.1 tsutsui 144 1.1 tsutsui static int psgpam_intr(void *); 145 1.1 tsutsui 146 1.1 tsutsui #if defined(AUDIO_DEBUG) 147 1.1 tsutsui static int psgpam_sysctl_debug(SYSCTLFN_PROTO); 148 1.1 tsutsui #endif 149 1.1 tsutsui static int psgpam_sysctl_enc(SYSCTLFN_PROTO); 150 1.1 tsutsui static int psgpam_sysctl_dynamic(SYSCTLFN_PROTO); 151 1.1 tsutsui 152 1.1 tsutsui CFATTACH_DECL_NEW(psgpam, sizeof(struct psgpam_softc), 153 1.1 tsutsui psgpam_match, psgpam_attach, NULL, NULL); 154 1.1 tsutsui 155 1.1 tsutsui static int psgpam_matched; 156 1.1 tsutsui 157 1.1 tsutsui static const struct audio_hw_if psgpam_hw_if = { 158 1.1 tsutsui .open = psgpam_open, 159 1.1 tsutsui .close = psgpam_close, 160 1.1 tsutsui .query_format = psgpam_query_format, 161 1.1 tsutsui .set_format = psgpam_set_format, 162 1.1 tsutsui .trigger_output = psgpam_trigger_output, 163 1.1 tsutsui .halt_output = psgpam_halt_output, 164 1.1 tsutsui .getdev = psgpam_getdev, 165 1.1 tsutsui .set_port = psgpam_set_port, 166 1.1 tsutsui .get_port = psgpam_get_port, 167 1.1 tsutsui .query_devinfo = psgpam_query_devinfo, 168 1.1 tsutsui .get_props = psgpam_get_props, 169 1.1 tsutsui .get_locks = psgpam_get_locks, 170 1.1 tsutsui .round_blocksize = psgpam_round_blocksize, 171 1.1 tsutsui .round_buffersize = psgpam_round_buffersize, 172 1.1 tsutsui }; 173 1.1 tsutsui 174 1.1 tsutsui static struct audio_device psgpam_device = { 175 1.1 tsutsui "PSG PAM", 176 1.1 tsutsui "0.2", 177 1.1 tsutsui "", 178 1.1 tsutsui }; 179 1.1 tsutsui 180 1.1 tsutsui static struct audio_format psgpam_format = { 181 1.1 tsutsui .mode = AUMODE_PLAY, 182 1.1 tsutsui .encoding = AUDIO_ENCODING_NONE, 183 1.1 tsutsui .validbits = 0, /* filled by query_format */ 184 1.1 tsutsui .precision = 0, /* filled by query_format */ 185 1.1 tsutsui .channels = 1, 186 1.1 tsutsui .channel_mask = AUFMT_MONAURAL, 187 1.1 tsutsui .frequency_type = 0, /* filled by query_format */ 188 1.1 tsutsui .frequency = { 0 }, /* filled by query_format */ 189 1.1 tsutsui }; 190 1.1 tsutsui 191 1.1 tsutsui static int 192 1.1 tsutsui psgpam_match(device_t parent, cfdata_t cf, void *aux) 193 1.1 tsutsui { 194 1.1 tsutsui struct xpbus_attach_args *xa = aux; 195 1.1 tsutsui 196 1.1 tsutsui if (psgpam_matched) 197 1.1 tsutsui return 0; 198 1.1 tsutsui 199 1.2 tsutsui /* Only the first generation LUNA has YM2149 at XP */ 200 1.2 tsutsui if (machtype != LUNA_I) 201 1.2 tsutsui return 0; 202 1.2 tsutsui 203 1.1 tsutsui if (strcmp(xa->xa_name, psgpam_cd.cd_name)) 204 1.1 tsutsui return 0; 205 1.1 tsutsui 206 1.1 tsutsui psgpam_matched = 1; 207 1.1 tsutsui return 1; 208 1.1 tsutsui } 209 1.1 tsutsui 210 1.1 tsutsui static void 211 1.1 tsutsui psgpam_attach(device_t parent, device_t self, void *aux) 212 1.1 tsutsui { 213 1.1 tsutsui struct psgpam_softc *sc; 214 1.1 tsutsui const struct sysctlnode *node; 215 1.1 tsutsui 216 1.1 tsutsui sc = device_private(self); 217 1.1 tsutsui sc->sc_dev = self; 218 1.1 tsutsui 219 1.1 tsutsui aprint_normal(": HD647180X I/O processor as PSG PAM\n"); 220 1.1 tsutsui 221 1.1 tsutsui sc->sc_shm_base = XP_SHM_BASE; 222 1.1 tsutsui sc->sc_shm_size = XP_SHM_SIZE; 223 1.1 tsutsui 224 1.1 tsutsui sc->sc_xp_enc = PAM_ENC_PAM2A; 225 1.1 tsutsui sc->sc_sample_rate = 8000; 226 1.1 tsutsui sc->sc_stride = 2; 227 1.1 tsutsui sc->sc_dynamic = 1; 228 1.1 tsutsui 229 1.1 tsutsui mutex_init(&sc->sc_thread_lock, MUTEX_DEFAULT, IPL_NONE); 230 1.1 tsutsui mutex_init(&sc->sc_intr_lock, MUTEX_DEFAULT, IPL_SCHED); 231 1.1 tsutsui 232 1.1 tsutsui isrlink_autovec(psgpam_intr, sc, 5, ISRPRI_TTYNOBUF); 233 1.1 tsutsui 234 1.1 tsutsui sysctl_createv(NULL, 0, NULL, &node, 235 1.1 tsutsui 0, 236 1.1 tsutsui CTLTYPE_NODE, device_xname(sc->sc_dev), 237 1.1 tsutsui SYSCTL_DESCR("psgpam"), 238 1.1 tsutsui NULL, 0, 239 1.1 tsutsui NULL, 0, 240 1.1 tsutsui CTL_HW, 241 1.1 tsutsui CTL_CREATE, CTL_EOL); 242 1.1 tsutsui if (node != NULL) { 243 1.1 tsutsui #if defined(AUDIO_DEBUG) 244 1.1 tsutsui sysctl_createv(NULL, 0, NULL, NULL, 245 1.1 tsutsui CTLFLAG_READWRITE, 246 1.1 tsutsui CTLTYPE_INT, "debug", 247 1.1 tsutsui SYSCTL_DESCR("PSGPAM debug"), 248 1.1 tsutsui psgpam_sysctl_debug, 0, (void *)sc, 0, 249 1.1 tsutsui CTL_HW, node->sysctl_num, 250 1.1 tsutsui CTL_CREATE, CTL_EOL); 251 1.1 tsutsui #endif 252 1.1 tsutsui sysctl_createv(NULL, 0, NULL, NULL, 253 1.1 tsutsui CTLFLAG_READWRITE, 254 1.1 tsutsui CTLTYPE_INT, "enc", 255 1.1 tsutsui SYSCTL_DESCR("PSGPAM encoding"), 256 1.1 tsutsui psgpam_sysctl_enc, 0, (void *)sc, 0, 257 1.1 tsutsui CTL_HW, node->sysctl_num, 258 1.1 tsutsui CTL_CREATE, CTL_EOL); 259 1.1 tsutsui sysctl_createv(NULL, 0, NULL, NULL, 260 1.1 tsutsui CTLFLAG_READWRITE, 261 1.1 tsutsui CTLTYPE_INT, "dynamic", 262 1.1 tsutsui SYSCTL_DESCR("PSGPAM dynamic offset"), 263 1.1 tsutsui psgpam_sysctl_dynamic, 0, (void *)sc, 0, 264 1.1 tsutsui CTL_HW, node->sysctl_num, 265 1.1 tsutsui CTL_CREATE, CTL_EOL); 266 1.1 tsutsui } 267 1.1 tsutsui 268 1.1 tsutsui audio_attach_mi(&psgpam_hw_if, sc, sc->sc_dev); 269 1.1 tsutsui } 270 1.1 tsutsui 271 1.1 tsutsui /* private functions */ 272 1.1 tsutsui 273 1.1 tsutsui static void 274 1.1 tsutsui psgpam_xp_query(struct psgpam_softc *sc) 275 1.1 tsutsui { 276 1.1 tsutsui u_int a; 277 1.1 tsutsui int r; 278 1.1 tsutsui 279 1.1 tsutsui if (!sc->sc_isopen) { 280 1.1 tsutsui a = xp_acquire(DEVID_PAM, 0); 281 1.1 tsutsui if (a == 0) { 282 1.1 tsutsui sc->sc_xp_cycle_clk = 65535; 283 1.1 tsutsui sc->sc_xp_rept_clk = 255; 284 1.1 tsutsui sc->sc_xp_rept_max = 0; 285 1.1 tsutsui DPRINTF(1, "XPLX BUSY!\n"); 286 1.1 tsutsui return; 287 1.1 tsutsui } 288 1.1 tsutsui xp_ensure_firmware(); 289 1.1 tsutsui } 290 1.1 tsutsui 291 1.1 tsutsui xp_writemem8(PAM_ENC, sc->sc_xp_enc); 292 1.1 tsutsui r = xp_cmd(DEVID_PAM, PAM_CMD_QUERY); 293 1.1 tsutsui if (r != XPLX_R_OK) { 294 1.1 tsutsui sc->sc_xp_cycle_clk = 65535; 295 1.1 tsutsui sc->sc_xp_rept_clk = 255; 296 1.1 tsutsui sc->sc_xp_rept_max = 0; 297 1.1 tsutsui DPRINTF(1, "XPLX QUERY FAIL: %d\n", r); 298 1.1 tsutsui } else { 299 1.1 tsutsui sc->sc_xp_cycle_clk = xp_readmem16le(PAM_CYCLE_CLK); 300 1.1 tsutsui sc->sc_xp_rept_clk = xp_readmem8(PAM_REPT_CLK); 301 1.1 tsutsui sc->sc_xp_rept_max = xp_readmem8(PAM_REPT_MAX); 302 1.1 tsutsui DPRINTF(1, "xp cycle_clk=%d rept_clk=%d rept_max=%d\n", 303 1.1 tsutsui sc->sc_xp_cycle_clk, 304 1.1 tsutsui sc->sc_xp_rept_clk, 305 1.1 tsutsui sc->sc_xp_rept_max); 306 1.1 tsutsui } 307 1.1 tsutsui if (!sc->sc_isopen) { 308 1.1 tsutsui xp_release(DEVID_PAM); 309 1.1 tsutsui } 310 1.1 tsutsui } 311 1.1 tsutsui 312 1.1 tsutsui static void 313 1.1 tsutsui psgpam_xp_start(struct psgpam_softc *sc) 314 1.1 tsutsui { 315 1.1 tsutsui 316 1.1 tsutsui DPRINTF(3, "XP PAM starting.."); 317 1.1 tsutsui if (xp_readmem8(PAM_RUN) != 0) { 318 1.1 tsutsui DPRINTF(1, "XP PAM already started???\n"); 319 1.1 tsutsui } 320 1.1 tsutsui 321 1.1 tsutsui psgpam_xp_query(sc); 322 1.1 tsutsui 323 1.1 tsutsui sc->sc_xp_rept = (XP_CPU_FREQ / sc->sc_sample_rate 324 1.1 tsutsui - sc->sc_xp_cycle_clk) / sc->sc_xp_rept_clk; 325 1.1 tsutsui if (sc->sc_xp_rept < 0) 326 1.1 tsutsui sc->sc_xp_rept = 0; 327 1.1 tsutsui if (sc->sc_xp_rept > sc->sc_xp_rept_max) 328 1.1 tsutsui sc->sc_xp_rept = sc->sc_xp_rept_max; 329 1.1 tsutsui xp_writemem8(PAM_REPT, sc->sc_xp_rept); 330 1.1 tsutsui DPRINTF(3, "ENC=%d REPT=%d\n", sc->sc_xp_enc, sc->sc_xp_rept); 331 1.1 tsutsui 332 1.1 tsutsui xp_intr5_enable(); 333 1.1 tsutsui xp_cmd_nowait(DEVID_PAM, PAM_CMD_START); 334 1.1 tsutsui 335 1.1 tsutsui DPRINTF(3, "XP PAM started\n"); 336 1.1 tsutsui } 337 1.1 tsutsui 338 1.1 tsutsui /* MI MD API */ 339 1.1 tsutsui 340 1.1 tsutsui static int 341 1.1 tsutsui psgpam_open(void *hdl, int flags) 342 1.1 tsutsui { 343 1.1 tsutsui struct psgpam_softc *sc; 344 1.1 tsutsui u_int a; 345 1.1 tsutsui 346 1.1 tsutsui DPRINTF(1, "%s: flags=0x%x\n", __func__, flags); 347 1.1 tsutsui sc = hdl; 348 1.1 tsutsui 349 1.1 tsutsui a = xp_acquire(DEVID_PAM, 0); 350 1.1 tsutsui if (a == 0) 351 1.1 tsutsui return EBUSY; 352 1.1 tsutsui 353 1.1 tsutsui /* firmware transfer */ 354 1.1 tsutsui xp_ensure_firmware(); 355 1.1 tsutsui 356 1.1 tsutsui sc->sc_xp_state = 0; 357 1.1 tsutsui sc->sc_started = 0; 358 1.1 tsutsui sc->sc_outcount = 0; 359 1.1 tsutsui sc->sc_isopen = 1; 360 1.1 tsutsui 361 1.1 tsutsui memset(xp_shmptr(PAM_BUF), XP_ATN_RESET, PAM_BUF_LEN); 362 1.1 tsutsui 363 1.1 tsutsui return 0; 364 1.1 tsutsui } 365 1.1 tsutsui 366 1.1 tsutsui static void 367 1.1 tsutsui psgpam_close(void *hdl) 368 1.1 tsutsui { 369 1.1 tsutsui struct psgpam_softc *sc; 370 1.1 tsutsui 371 1.1 tsutsui sc = hdl; 372 1.1 tsutsui 373 1.1 tsutsui xp_intr5_disable(); 374 1.1 tsutsui 375 1.1 tsutsui xp_release(DEVID_PAM); 376 1.1 tsutsui 377 1.1 tsutsui sc->sc_isopen = 0; 378 1.1 tsutsui 379 1.1 tsutsui DPRINTF(1, "%s\n", __func__); 380 1.1 tsutsui } 381 1.1 tsutsui 382 1.1 tsutsui static int 383 1.1 tsutsui psgpam_query_format(void *hdl, audio_format_query_t *afp) 384 1.1 tsutsui { 385 1.1 tsutsui struct psgpam_softc *sc; 386 1.1 tsutsui u_int freq; 387 1.1 tsutsui uint8_t rept_max; 388 1.1 tsutsui int clk; 389 1.1 tsutsui int i, n; 390 1.1 tsutsui 391 1.1 tsutsui #define XP_FREQ_MAXCOUNT 40 392 1.1 tsutsui int f[XP_FREQ_MAXCOUNT]; 393 1.1 tsutsui 394 1.1 tsutsui if (afp->index != 0) 395 1.1 tsutsui return EINVAL; 396 1.1 tsutsui 397 1.1 tsutsui sc = hdl; 398 1.1 tsutsui 399 1.1 tsutsui psgpam_xp_query(sc); 400 1.1 tsutsui switch (sc->sc_xp_enc) { 401 1.1 tsutsui case PAM_ENC_PAM2A: 402 1.1 tsutsui case PAM_ENC_PAM2B: 403 1.1 tsutsui psgpam_format.validbits = 16; 404 1.1 tsutsui psgpam_format.precision = 16; 405 1.1 tsutsui break; 406 1.1 tsutsui case PAM_ENC_PAM3A: 407 1.1 tsutsui case PAM_ENC_PAM3B: 408 1.1 tsutsui psgpam_format.validbits = 32; 409 1.1 tsutsui psgpam_format.precision = 32; 410 1.1 tsutsui break; 411 1.1 tsutsui } 412 1.1 tsutsui 413 1.1 tsutsui /* convert xp's max to AUFMT's max */ 414 1.1 tsutsui rept_max = sc->sc_xp_rept_max + 1; 415 1.1 tsutsui 416 1.1 tsutsui if (rept_max <= AUFMT_MAX_FREQUENCIES) { 417 1.1 tsutsui /* all choice */ 418 1.1 tsutsui for (i = 0; i < rept_max; i++) { 419 1.1 tsutsui clk = sc->sc_xp_cycle_clk + i * sc->sc_xp_rept_clk; 420 1.1 tsutsui freq = XP_CPU_FREQ / clk; 421 1.1 tsutsui psgpam_format.frequency[i] = freq; 422 1.1 tsutsui } 423 1.1 tsutsui n = rept_max; 424 1.1 tsutsui } else { 425 1.1 tsutsui if (rept_max > XP_FREQ_MAXCOUNT) 426 1.1 tsutsui rept_max = XP_FREQ_MAXCOUNT; 427 1.1 tsutsui 428 1.1 tsutsui for (i = 0; i < rept_max; i++) { 429 1.1 tsutsui clk = sc->sc_xp_cycle_clk + i * sc->sc_xp_rept_clk; 430 1.1 tsutsui freq = XP_CPU_FREQ / clk; 431 1.1 tsutsui if (freq < 4000) break; 432 1.1 tsutsui f[i] = freq; 433 1.1 tsutsui } 434 1.1 tsutsui for (; i < XP_FREQ_MAXCOUNT; i++) 435 1.1 tsutsui f[i] = 0; 436 1.1 tsutsui 437 1.1 tsutsui /* 438 1.1 tsutsui * keep: first, last 439 1.1 tsutsui * remove: any unusable freq 440 1.1 tsutsui */ 441 1.1 tsutsui for (i = 1; i < rept_max - 1; i++) { 442 1.1 tsutsui if (( 4000 <= f[i] && f[i] < 6000 && 443 1.1 tsutsui f[i - 1] < 6000 && f[i + 1] > 4000) || 444 1.1 tsutsui ( 6000 <= f[i] && f[i] < 8000 && 445 1.1 tsutsui f[i - 1] < 8000 && f[i + 1] > 6000) || 446 1.1 tsutsui ( 8000 <= f[i] && f[i] < 12000 && 447 1.1 tsutsui f[i - 1] < 12000 && f[i + 1] > 8000) || 448 1.1 tsutsui (12000 <= f[i] && f[i] < 16000 && 449 1.1 tsutsui f[i - 1] < 16000 && f[i + 1] > 12000)) { 450 1.1 tsutsui f[i] = 0; 451 1.1 tsutsui } 452 1.1 tsutsui } 453 1.1 tsutsui n = 0; 454 1.1 tsutsui for (i = 0; i < rept_max; i++) { 455 1.1 tsutsui if (f[i] != 0) { 456 1.1 tsutsui psgpam_format.frequency[n] = f[i]; 457 1.1 tsutsui n++; 458 1.1 tsutsui if (n == AUFMT_MAX_FREQUENCIES) 459 1.1 tsutsui break; 460 1.1 tsutsui } 461 1.1 tsutsui } 462 1.1 tsutsui } 463 1.1 tsutsui 464 1.1 tsutsui psgpam_format.frequency_type = n; 465 1.1 tsutsui 466 1.1 tsutsui afp->fmt = psgpam_format; 467 1.1 tsutsui return 0; 468 1.1 tsutsui } 469 1.1 tsutsui 470 1.1 tsutsui static int 471 1.1 tsutsui psgpam_set_format(void *hdl, int setmode, 472 1.1 tsutsui const audio_params_t *play, const audio_params_t *rec, 473 1.1 tsutsui audio_filter_reg_t *pfil, audio_filter_reg_t *rfil) 474 1.1 tsutsui { 475 1.1 tsutsui /* called before open */ 476 1.1 tsutsui 477 1.1 tsutsui struct psgpam_softc *sc; 478 1.1 tsutsui 479 1.1 tsutsui sc = hdl; 480 1.1 tsutsui DPRINTF(1, "%s: mode=%d %s/%dbit/%dch/%dHz\n", __func__, 481 1.1 tsutsui setmode, audio_encoding_name(play->encoding), 482 1.1 tsutsui play->precision, play->channels, play->sample_rate); 483 1.1 tsutsui 484 1.1 tsutsui sc->sc_sample_rate = play->sample_rate; 485 1.1 tsutsui 486 1.1 tsutsui /* set filter */ 487 1.1 tsutsui switch (sc->sc_xp_enc) { 488 1.1 tsutsui case PAM_ENC_PAM2A: 489 1.1 tsutsui if (sc->sc_dynamic) { 490 1.1 tsutsui pfil->codec = psgpam_aint_to_pam2a_d; 491 1.1 tsutsui } else { 492 1.1 tsutsui pfil->codec = psgpam_aint_to_pam2a; 493 1.1 tsutsui } 494 1.1 tsutsui sc->sc_stride = 2; 495 1.1 tsutsui break; 496 1.1 tsutsui case PAM_ENC_PAM2B: 497 1.1 tsutsui if (sc->sc_dynamic) { 498 1.1 tsutsui pfil->codec = psgpam_aint_to_pam2b_d; 499 1.1 tsutsui } else { 500 1.1 tsutsui pfil->codec = psgpam_aint_to_pam2b; 501 1.1 tsutsui } 502 1.1 tsutsui sc->sc_stride = 2; 503 1.1 tsutsui break; 504 1.1 tsutsui case PAM_ENC_PAM3A: 505 1.1 tsutsui if (sc->sc_dynamic) { 506 1.1 tsutsui pfil->codec = psgpam_aint_to_pam3a_d; 507 1.1 tsutsui } else { 508 1.1 tsutsui pfil->codec = psgpam_aint_to_pam3a; 509 1.1 tsutsui } 510 1.1 tsutsui sc->sc_stride = 4; 511 1.1 tsutsui break; 512 1.1 tsutsui case PAM_ENC_PAM3B: 513 1.1 tsutsui if (sc->sc_dynamic) { 514 1.1 tsutsui pfil->codec = psgpam_aint_to_pam3b_d; 515 1.1 tsutsui } else { 516 1.1 tsutsui pfil->codec = psgpam_aint_to_pam3b; 517 1.1 tsutsui } 518 1.1 tsutsui sc->sc_stride = 4; 519 1.1 tsutsui break; 520 1.1 tsutsui } 521 1.1 tsutsui psgpam_init_context(&sc->sc_psgpam_codecvar, sc->sc_sample_rate); 522 1.1 tsutsui pfil->context = &sc->sc_psgpam_codecvar; 523 1.1 tsutsui 524 1.1 tsutsui return 0; 525 1.1 tsutsui } 526 1.1 tsutsui 527 1.1 tsutsui /* marking block */ 528 1.1 tsutsui static void 529 1.1 tsutsui psgpam_mark_blk(struct psgpam_softc *sc, int blk_id) 530 1.1 tsutsui { 531 1.1 tsutsui int markoffset; 532 1.1 tsutsui uint marker; 533 1.1 tsutsui 534 1.1 tsutsui markoffset = sc->sc_blksize * (blk_id + 1); 535 1.1 tsutsui 536 1.1 tsutsui if (blk_id == sc->sc_blkcount - 1) { 537 1.1 tsutsui marker = XP_ATN_RELOAD; 538 1.1 tsutsui } else { 539 1.1 tsutsui marker = XP_ATN_STAT; 540 1.1 tsutsui } 541 1.1 tsutsui 542 1.1 tsutsui /* marking */ 543 1.1 tsutsui uint8_t *start = sc->sc_start_ptr; 544 1.1 tsutsui if (sc->sc_stride == 2) { 545 1.1 tsutsui uint16_t *markptr = (uint16_t*)(start + markoffset); 546 1.1 tsutsui markptr -= 1; 547 1.1 tsutsui *markptr |= marker; 548 1.1 tsutsui } else { 549 1.1 tsutsui /* stride == 4 */ 550 1.1 tsutsui uint32_t *markptr = (uint32_t*)(start + markoffset); 551 1.1 tsutsui markptr -= 1; 552 1.1 tsutsui *markptr |= marker; 553 1.1 tsutsui } 554 1.1 tsutsui } 555 1.1 tsutsui 556 1.1 tsutsui static int 557 1.1 tsutsui psgpam_trigger_output(void *hdl, void *start, void *end, int blksize, 558 1.1 tsutsui void (*intr)(void *), void *intrarg, const audio_params_t *param) 559 1.1 tsutsui { 560 1.1 tsutsui void *dp; 561 1.1 tsutsui struct psgpam_softc *sc; 562 1.1 tsutsui 563 1.1 tsutsui sc = hdl; 564 1.1 tsutsui 565 1.1 tsutsui DPRINTF(2, "%s start=%p end=%p blksize=%d\n", __func__, 566 1.1 tsutsui start, end, blksize); 567 1.1 tsutsui 568 1.1 tsutsui sc->sc_outcount++; 569 1.1 tsutsui 570 1.1 tsutsui sc->sc_intr = intr; 571 1.1 tsutsui sc->sc_arg = intrarg; 572 1.1 tsutsui sc->sc_blksize = blksize; 573 1.1 tsutsui 574 1.1 tsutsui sc->sc_start_ptr = start; 575 1.1 tsutsui sc->sc_end_ptr = end; 576 1.1 tsutsui sc->sc_blkcount = (sc->sc_end_ptr - sc->sc_start_ptr) / sc->sc_blksize; 577 1.1 tsutsui sc->sc_xp_addr = PAM_BUF; 578 1.1 tsutsui 579 1.1 tsutsui psgpam_mark_blk(sc, 0); 580 1.1 tsutsui psgpam_mark_blk(sc, 1); 581 1.1 tsutsui 582 1.1 tsutsui /* transfer */ 583 1.1 tsutsui dp = xp_shmptr(sc->sc_xp_addr); 584 1.1 tsutsui memcpy(dp, start, blksize * 2); 585 1.1 tsutsui 586 1.1 tsutsui /* (preincrement variable in intr) */ 587 1.1 tsutsui sc->sc_cur_blk_id = 1; 588 1.1 tsutsui sc->sc_xp_addr += blksize; 589 1.1 tsutsui 590 1.1 tsutsui /* play start */ 591 1.1 tsutsui if (sc->sc_started == 0) { 592 1.1 tsutsui /* set flag first */ 593 1.1 tsutsui sc->sc_started = 1; 594 1.1 tsutsui psgpam_xp_start(sc); 595 1.1 tsutsui } 596 1.1 tsutsui 597 1.1 tsutsui return 0; 598 1.1 tsutsui } 599 1.1 tsutsui 600 1.1 tsutsui static int 601 1.1 tsutsui psgpam_halt_output(void *hdl) 602 1.1 tsutsui { 603 1.1 tsutsui struct psgpam_softc *sc = hdl; 604 1.1 tsutsui 605 1.1 tsutsui DPRINTF(2, "%s\n", __func__); 606 1.1 tsutsui 607 1.1 tsutsui xp_intr5_disable(); 608 1.1 tsutsui 609 1.1 tsutsui memset(xp_shmptr(PAM_BUF), XP_ATN_RESET, PAM_BUF_LEN); 610 1.1 tsutsui 611 1.1 tsutsui sc->sc_started = 0; 612 1.1 tsutsui sc->sc_xp_state = 0; 613 1.1 tsutsui 614 1.1 tsutsui return 0; 615 1.1 tsutsui } 616 1.1 tsutsui 617 1.1 tsutsui static int 618 1.1 tsutsui psgpam_getdev(void *hdl, struct audio_device *ret) 619 1.1 tsutsui { 620 1.1 tsutsui 621 1.1 tsutsui *ret = psgpam_device; 622 1.1 tsutsui return 0; 623 1.1 tsutsui } 624 1.1 tsutsui 625 1.1 tsutsui static int 626 1.1 tsutsui psgpam_set_port(void *hdl, mixer_ctrl_t *mc) 627 1.1 tsutsui { 628 1.1 tsutsui 629 1.1 tsutsui DPRINTF(2, "%s\n", __func__); 630 1.1 tsutsui return 0; 631 1.1 tsutsui } 632 1.1 tsutsui 633 1.1 tsutsui static int 634 1.1 tsutsui psgpam_get_port(void *hdl, mixer_ctrl_t *mc) 635 1.1 tsutsui { 636 1.1 tsutsui 637 1.1 tsutsui DPRINTF(2, "%s\n", __func__); 638 1.1 tsutsui return 0; 639 1.1 tsutsui } 640 1.1 tsutsui 641 1.1 tsutsui static int 642 1.1 tsutsui psgpam_query_devinfo(void *hdl, mixer_devinfo_t *di) 643 1.1 tsutsui { 644 1.1 tsutsui 645 1.1 tsutsui DPRINTF(2, "%s %d\n", __func__, di->index); 646 1.1 tsutsui switch (di->index) { 647 1.1 tsutsui default: 648 1.1 tsutsui return EINVAL; 649 1.1 tsutsui } 650 1.1 tsutsui return 0; 651 1.1 tsutsui } 652 1.1 tsutsui 653 1.1 tsutsui static int 654 1.1 tsutsui psgpam_get_props(void *hdl) 655 1.1 tsutsui { 656 1.1 tsutsui 657 1.1 tsutsui return AUDIO_PROP_PLAYBACK; 658 1.1 tsutsui } 659 1.1 tsutsui 660 1.1 tsutsui static void 661 1.1 tsutsui psgpam_get_locks(void *hdl, kmutex_t **intr, kmutex_t **thread) 662 1.1 tsutsui { 663 1.1 tsutsui struct psgpam_softc *sc = hdl; 664 1.1 tsutsui 665 1.1 tsutsui *intr = &sc->sc_intr_lock; 666 1.1 tsutsui *thread = &sc->sc_thread_lock; 667 1.1 tsutsui } 668 1.1 tsutsui 669 1.1 tsutsui static int 670 1.1 tsutsui psgpam_round_blocksize(void *hdl, int bs, int mode, 671 1.1 tsutsui const audio_params_t *param) 672 1.1 tsutsui { 673 1.1 tsutsui 674 1.1 tsutsui #if 0 675 1.1 tsutsui if (bs < 16384) { 676 1.1 tsutsui return (16384 / bs) * bs; 677 1.1 tsutsui } else { 678 1.1 tsutsui return 16384; 679 1.1 tsutsui } 680 1.1 tsutsui #else 681 1.1 tsutsui return bs; 682 1.1 tsutsui #endif 683 1.1 tsutsui } 684 1.1 tsutsui 685 1.1 tsutsui static size_t 686 1.1 tsutsui psgpam_round_buffersize(void *hdl, int direction, size_t bufsize) 687 1.1 tsutsui { 688 1.1 tsutsui 689 1.1 tsutsui if (bufsize > 28 * 1024) { 690 1.1 tsutsui bufsize = 28 * 1024; 691 1.1 tsutsui } 692 1.1 tsutsui return bufsize; 693 1.1 tsutsui } 694 1.1 tsutsui 695 1.1 tsutsui static int 696 1.1 tsutsui psgpam_intr(void *hdl) 697 1.1 tsutsui { 698 1.1 tsutsui struct psgpam_softc *sc = hdl; 699 1.1 tsutsui 700 1.1 tsutsui xp_intr5_acknowledge(); 701 1.1 tsutsui DPRINTF(4, "psgpam intr\n"); 702 1.1 tsutsui 703 1.1 tsutsui sc->sc_cur_blk_id++; 704 1.1 tsutsui sc->sc_xp_addr += sc->sc_blksize; 705 1.1 tsutsui if (sc->sc_cur_blk_id == sc->sc_blkcount) { 706 1.1 tsutsui sc->sc_cur_blk_id = 0; 707 1.1 tsutsui sc->sc_xp_addr = PAM_BUF; 708 1.1 tsutsui } 709 1.1 tsutsui psgpam_mark_blk(sc, sc->sc_cur_blk_id); 710 1.1 tsutsui memcpy(xp_shmptr(sc->sc_xp_addr), 711 1.1 tsutsui sc->sc_start_ptr + sc->sc_cur_blk_id * sc->sc_blksize, 712 1.1 tsutsui sc->sc_blksize); 713 1.1 tsutsui 714 1.1 tsutsui mutex_spin_enter(&sc->sc_intr_lock); 715 1.1 tsutsui 716 1.1 tsutsui if (sc->sc_intr) { 717 1.1 tsutsui sc->sc_intr(sc->sc_arg); 718 1.1 tsutsui } else { 719 1.1 tsutsui DPRINTF(1, "psgpam_intr: spurious interrupt\n"); 720 1.1 tsutsui } 721 1.1 tsutsui 722 1.1 tsutsui mutex_spin_exit(&sc->sc_intr_lock); 723 1.1 tsutsui 724 1.1 tsutsui /* handled */ 725 1.1 tsutsui return 1; 726 1.1 tsutsui } 727 1.1 tsutsui 728 1.1 tsutsui #if defined(AUDIO_DEBUG) 729 1.1 tsutsui /* sysctl */ 730 1.1 tsutsui static int 731 1.1 tsutsui psgpam_sysctl_debug(SYSCTLFN_ARGS) 732 1.1 tsutsui { 733 1.1 tsutsui struct sysctlnode node; 734 1.1 tsutsui int t, error; 735 1.1 tsutsui 736 1.1 tsutsui node = *rnode; 737 1.1 tsutsui 738 1.1 tsutsui t = psgpamdebug; 739 1.1 tsutsui node.sysctl_data = &t; 740 1.1 tsutsui 741 1.1 tsutsui error = sysctl_lookup(SYSCTLFN_CALL(&node)); 742 1.1 tsutsui if (error || newp == NULL) { 743 1.1 tsutsui return error; 744 1.1 tsutsui } 745 1.1 tsutsui 746 1.1 tsutsui if (t < 0) 747 1.1 tsutsui return EINVAL; 748 1.1 tsutsui if (t > 4) 749 1.1 tsutsui return EINVAL; 750 1.1 tsutsui psgpamdebug = t; 751 1.1 tsutsui return 0; 752 1.1 tsutsui } 753 1.1 tsutsui #endif 754 1.1 tsutsui 755 1.1 tsutsui /* sysctl */ 756 1.1 tsutsui static int 757 1.1 tsutsui psgpam_sysctl_enc(SYSCTLFN_ARGS) 758 1.1 tsutsui { 759 1.1 tsutsui struct sysctlnode node; 760 1.1 tsutsui struct psgpam_softc *sc; 761 1.1 tsutsui int t, error; 762 1.1 tsutsui 763 1.1 tsutsui node = *rnode; 764 1.1 tsutsui sc = node.sysctl_data; 765 1.1 tsutsui 766 1.1 tsutsui t = sc->sc_xp_enc; 767 1.1 tsutsui node.sysctl_data = &t; 768 1.1 tsutsui 769 1.1 tsutsui error = sysctl_lookup(SYSCTLFN_CALL(&node)); 770 1.1 tsutsui if (error || newp == NULL) { 771 1.1 tsutsui return error; 772 1.1 tsutsui } 773 1.1 tsutsui 774 1.1 tsutsui if (t < PAM_ENC_PAM2A) 775 1.1 tsutsui return EINVAL; 776 1.1 tsutsui if (t > PAM_ENC_PAM3B) 777 1.1 tsutsui return EINVAL; 778 1.1 tsutsui sc->sc_xp_enc = t; 779 1.1 tsutsui return 0; 780 1.1 tsutsui } 781 1.1 tsutsui 782 1.1 tsutsui static int 783 1.1 tsutsui psgpam_sysctl_dynamic(SYSCTLFN_ARGS) 784 1.1 tsutsui { 785 1.1 tsutsui struct sysctlnode node; 786 1.1 tsutsui struct psgpam_softc *sc; 787 1.1 tsutsui int t, error; 788 1.1 tsutsui 789 1.1 tsutsui node = *rnode; 790 1.1 tsutsui sc = node.sysctl_data; 791 1.1 tsutsui 792 1.1 tsutsui t = sc->sc_dynamic; 793 1.1 tsutsui node.sysctl_data = &t; 794 1.1 tsutsui 795 1.1 tsutsui error = sysctl_lookup(SYSCTLFN_CALL(&node)); 796 1.1 tsutsui if (error || newp == NULL) { 797 1.1 tsutsui return error; 798 1.1 tsutsui } 799 1.1 tsutsui 800 1.1 tsutsui sc->sc_dynamic = t; 801 1.1 tsutsui return 0; 802 1.1 tsutsui } 803