/*
 * SPDX-License-Identifier: BSD-2-Clause
 *
 * Copyright (c) 2024 The FreeBSD Foundation
 * Copyright (c) 2025 Goran Mekić
 *
 * Portions of this software were developed by Christos Margiolis
 * <christos@FreeBSD.org> under sponsorship from the FreeBSD Foundation.
 *
 * Redistribution and use in source and binary forms, with or without
 * modification, are permitted provided that the following conditions
 * are met:
 * 1. Redistributions of source code must retain the above copyright
 *    notice, this list of conditions and the following disclaimer.
 * 2. 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.
 *
 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR 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 AUTHOR 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.
 */

#include <sys/soundcard.h>
#include "oss.h"

/*
 * Split input buffer into channels. The input buffer is in interleaved format,
 * which means if we have 2 channels (L and R), this is what the buffer of 8
 * samples would contain: L,R,L,R,L,R,L,R. The result of this function is a
 * buffer containing: L,L,L,L,R,R,R,R.
 */
static void
to_channels(struct config *config, void *output)
{
        uint8_t *in = config->buf;
        uint8_t *out = output;
        int i, channel, index, offset, byte;

        /* Iterate over bytes in the input buffer */
        for (byte = 0; byte < config->buffer_info.bytes;
            byte += config->sample_size) {
                /*
                 * Get index of a sample in the input buffer measured in
                 * samples
                 */
                i = byte / config->sample_size;

                /* Get which channel is being processed */
                channel = i % config->audio_info.max_channels;

                /* Get offset of the sample inside a single channel */
                offset = i / config->audio_info.max_channels;

                /* Get index of a sample in the output buffer */
                index = (channel * config->chsamples + offset) *
                    config->sample_size;

                /* Copy singe sample from input to output */
                memcpy(out+index, in+byte, config->sample_size);
        }
}

/*
 * Convert channels into interleaved format and put into output buffer
 */
static void
to_interleaved(struct config *config, void *input)
{
        uint8_t *out = config->buf;
        uint8_t *in = input;
        int i, index, offset, channel, byte;

        /* Iterate over bytes in the input buffer */
        for (byte = 0; byte < config->buffer_info.bytes;
            byte += config->sample_size) {
                /*
                 * Get index of a sample in the input buffer measured in
                 * samples
                 */
                index = byte / config->sample_size;

                /* Get which channel is being processed */
                channel = index / config->chsamples;

                /* Get offset of the sample inside a single channel */
                offset = index % config->chsamples;

                /* Get index of a sample in the output buffer */
                i = (config->audio_info.max_channels * offset + channel) *
                    config->sample_size;

                /* Copy singe sample from input to output */
                memcpy(out+i, in+byte, config->sample_size);
        }
}

int
main(int argc, char *argv[])
{
        struct config config = {
                .device = "/dev/dsp",
                .mode = O_RDWR,
                .format = AFMT_S32_NE,
                .sample_rate = 48000,
        };
        int32_t *channels;
        int rc, bytes;

        oss_init(&config);
        if (config.format != AFMT_S32_NE)
                errx(1, "Device doesn't support signed 32bit samples. "
                        "Check with 'sndctl' if it can be configured for 's32le' format.");
        bytes = config.buffer_info.bytes;
        channels = malloc(bytes);

        for (;;) {
                if ((rc = read(config.fd, config.buf, bytes)) < bytes) {
                        warn("Requested %d bytes, but read %d!\n", bytes, rc);
                        break;
                }
                /*
                 * Strictly speaking, we could omit "channels" and operate only
                 * using config->buf, but this example tries to show the real
                 * world application usage. The problem is that the buffer is
                 * in interleaved format, and if you'd like to do any
                 * processing and/or mixing, it is easier to do that if samples
                 * are grouped per channel.
                 */
                to_channels(&config, channels);
                to_interleaved(&config, channels);
                if ((rc = write(config.fd, config.buf, bytes)) < bytes) {
                        warn("Requested %d bytes, but wrote %d!\n", bytes, rc);
                        break;
                }
        }

        free(channels);
        free(config.buf);
        close(config.fd);

        return (0);
}