Home | History | Annotate | Line # | Download | only in dev
      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