[Date Prev][Date Next][Thread Prev][Thread Next][Date Index][Thread Index]
[tyndur-devel] [PATCH 4/5] CDI/audio: ac97
From: Max Reitz <max@xxxxxxxxxx>
+ ac97-Treiber für CDI.audio implementiert, nicht auf echter Hardware
getestet.
Signed-off-by: Max Reitz <max@xxxxxxxxxx>
---
src/modules/cdi/ac97/Makefile.all | 6 +
src/modules/cdi/ac97/device.c | 311 +++++++++++++++++++++++++++++++++++++
src/modules/cdi/ac97/device.h | 115 ++++++++++++++
src/modules/cdi/ac97/main.c | 65 ++++++++
4 files changed, 497 insertions(+), 0 deletions(-)
create mode 100644 src/modules/cdi/ac97/Makefile.all
create mode 100644 src/modules/cdi/ac97/device.c
create mode 100644 src/modules/cdi/ac97/device.h
create mode 100644 src/modules/cdi/ac97/main.c
diff --git a/src/modules/cdi/ac97/Makefile.all b/src/modules/cdi/ac97/Makefile.all
new file mode 100644
index 0000000..9e98010
--- /dev/null
+++ b/src/modules/cdi/ac97/Makefile.all
@@ -0,0 +1,6 @@
+shopt -s extglob
+source $LOST_BUILDMK_ROOT/config.sh
+
+echo "LD $1/modules/ac97"
+$LOST_TOOLS_LD -oac97.mod $LDSCRIPT *.o --start-group $2 --end-group
+$LOST_TOOLS_STRIP -s ac97.mod -o $1/modules/ac97
diff --git a/src/modules/cdi/ac97/device.c b/src/modules/cdi/ac97/device.c
new file mode 100644
index 0000000..b43d01c
--- /dev/null
+++ b/src/modules/cdi/ac97/device.c
@@ -0,0 +1,311 @@
+/******************************************************************************
+ * Copyright (c) 2010 Max Reitz *
+ * *
+ * Permission is hereby granted, free of charge, to any person obtaining a *
+ * copy of this software and associated documentation files (the "Software"), *
+ * to deal in the Software without restriction, including without limitation *
+ * the rights to use, copy, modify, merge, publish, distribute, sublicense, *
+ * and/or sell copies of the Software, and to permit persons to whom the *
+ * Software is furnished to do so, subject to the following conditions: *
+ * *
+ * The above copyright notice and this permission notice shall be included in *
+ * all copies or substantial portions of the Software. *
+ * *
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR *
+ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, *
+ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL *
+ * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER *
+ * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING *
+ * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER *
+ * DEALINGS IN THE SOFTWARE. *
+ ******************************************************************************/
+
+#include <stdint.h>
+#include <stdlib.h>
+#include <string.h>
+
+#include "cdi.h"
+#include "cdi/audio.h"
+#include "cdi/io.h"
+#include "cdi/lists.h"
+#include "cdi/mem.h"
+#include "cdi/misc.h"
+#include "cdi/pci.h"
+
+#include "device.h"
+
+#define SAMPLES_PER_BUFFER 0xFFFE
+
+static void ac97_isr(struct cdi_device* device);
+
+struct cdi_device* ac97_init_device(struct cdi_bus_data* bus_data)
+{
+ struct cdi_pci_device* pci = (struct cdi_pci_device*) bus_data;
+
+ // Search for a usable device
+ if ((pci->vendor_id != 0x8086) || ((pci->device_id != 0x2415) &&
+ (pci->device_id != 0x2425) && (pci->device_id != 0x2445)))
+ {
+ return NULL;
+ }
+
+ struct ac97_device* dev = calloc(1, sizeof(*dev));
+
+ cdi_pci_alloc_ioports(pci);
+
+ // Get the I/O resources (NAMBAR and NABMBAR)
+ struct cdi_pci_resource* res;
+ int i;
+ for (i = 0; (res = cdi_list_get(pci->resources, i)); i++) {
+ if (res->type == CDI_PCI_IOPORTS) {
+ if (!res->index) {
+ dev->nambar = res->start;
+ } else if (res->index == 1) {
+ dev->nabmbar = res->start;
+ }
+ }
+ }
+
+ if (!dev->nambar || !dev->nabmbar) {
+ free(dev);
+ cdi_pci_free_ioports(pci);
+ return NULL;
+ }
+
+ #ifdef CDI_PCI_DIRECT_ACCESS
+ // If possible, activate the I/O resources and the busmaster capability
+ cdi_pci_config_writew(pci, 4, cdi_pci_config_readw(pci, 4) | 5);
+ #endif
+
+ struct ac97_card* ac97_card = malloc(sizeof(*ac97_card));
+ struct ac97_stream* ac97_stream = malloc(sizeof(*ac97_stream));
+
+ // Define the CDI.audio sound card
+ ac97_card->card.record = 0;
+ ac97_card->card.streams = cdi_list_create();
+ ac97_card->device = dev;
+
+ // And the only stream
+ ac97_stream->stream.device = &ac97_card->card;
+ ac97_stream->stream.num_buffers = 32;
+ ac97_stream->stream.buffer_size = SAMPLES_PER_BUFFER;
+ ac97_stream->stream.sample_format = CDI_AUDIO_16SI;
+
+ ac97_stream->device = dev;
+
+ dev->output = &ac97_stream->stream;
+
+ cdi_list_push(ac97_card->card.streams, ac97_stream);
+
+ // Register the IRQ
+ cdi_register_irq(pci->irq, &ac97_isr, &ac97_card->card.dev);
+
+ // Reset the card
+ cdi_outw(dev->nambar + NAM_RESET, 42);
+
+ cdi_sleep_ms(100);
+
+ // And still something...
+ cdi_outw(dev->nabmbar + NABM_PICONTROL, 0x02);
+ cdi_outw(dev->nabmbar + NABM_POCONTROL, 0x02);
+ cdi_outw(dev->nabmbar + NABM_MCCONTROL, 0x02);
+
+ cdi_sleep_ms(100);
+
+ // Set volume to 100 %
+ cdi_outw(dev->nambar + NAM_MASTER_VOLUME, 0x0000);
+ cdi_outw(dev->nambar + NAM_MONO_VOLUME, 0x00);
+ cdi_outw(dev->nambar + NAM_PC_BEEP, 0x00);
+ cdi_outw(dev->nambar + NAM_PCM_VOLUME, 0x0000);
+
+ cdi_sleep_ms(10);
+
+ // Test if sample rate is adjustable
+ if (!(cdi_inw(dev->nambar + NAM_EXT_AUDIO_ID) & 1)) {
+ // No it isn't; it's fixed to 48 kHz
+ ac97_stream->stream.fixed_sample_rate = 48000;
+ } else {
+ // Yes, it is
+ ac97_stream->stream.fixed_sample_rate = 0;
+
+ // Use that capability (Variable Audio Rate)
+ cdi_outw(dev->nambar + NAM_EXT_AUDIO_STC,
+ cdi_inw(dev->nambar + NAM_EXT_AUDIO_STC) | 1);
+
+ cdi_sleep_ms(10);
+
+ // Set the sample rate to 44.1 kHz
+ cdi_outw(dev->nambar + NAM_FRONT_SPLRATE, 44100);
+ cdi_outw(dev->nambar + NAM_LR_SPLRATE, 44100);
+ }
+
+ // TODO: Error handling
+
+ // Allocate the buffer descriptor array
+ struct cdi_mem_area* bd = cdi_mem_alloc(32 * sizeof(dev->bd[0]),
+ 3 | CDI_MEM_DMA_4G | CDI_MEM_PHYS_CONTIGUOUS);
+
+ dev->bd = bd->vaddr;
+ dev->vbd = calloc(32, sizeof(dev->vbd[0]));
+
+ for (i = 0; i < 32; i++)
+ {
+ // Allocate each buffer
+ struct cdi_mem_area* buffer = cdi_mem_alloc(SAMPLES_PER_BUFFER * 4,
+ 12 | CDI_MEM_DMA_4G | CDI_MEM_PHYS_CONTIGUOUS);
+
+ dev->bd[i].buffer = buffer->paddr.items->start;
+ dev->bd[i].length = SAMPLES_PER_BUFFER;
+ // Generate an IRQ on completion
+ dev->bd[i].flags = FLAG_IOC;
+ dev->vbd[i] = buffer->vaddr;
+
+ // Zero the buffer
+ memset(buffer->vaddr, 0, SAMPLES_PER_BUFFER * 4);
+ }
+
+ // Set the base address of the descriptor array
+ cdi_outl(dev->nabmbar + NABM_POBDBAR, bd->paddr.items->start);
+
+ // Return the new device
+ return &ac97_card->card.dev;
+}
+
+void ac97_remove_device(struct cdi_device* device)
+{
+ // TODO: Well...
+ (void) device;
+}
+
+int ac97_transfer_data(struct cdi_audio_stream* stream, size_t buffer,
+ struct cdi_mem_area* memory, size_t offset)
+{
+ // Check if buffer index is valid
+ if (buffer >= 32) {
+ return -1;
+ }
+
+ if (offset >= SAMPLES_PER_BUFFER) {
+ return -1;
+ }
+
+ struct ac97_stream* s = (struct ac97_stream*) stream;
+
+ // Copy the content to the AC97 buffer
+ memcpy((uint16_t*) s->device->vbd[buffer] + offset, memory->vaddr,
+ (SAMPLES_PER_BUFFER - offset) * 2);
+
+ return 0;
+}
+
+cdi_audio_status_t ac97_change_status(struct cdi_audio_device* device,
+ cdi_audio_status_t status)
+{
+ struct ac97_device* dev = ((struct ac97_card*) device)->device;
+
+ if (status == CDI_AUDIO_PLAY) {
+ // Start playback
+ cdi_outb(dev->nabmbar + NABM_POCONTROL, 0x11);
+ // Set last valid buffer index to 31
+ cdi_outb(dev->nabmbar + NABM_POLVI, 31);
+ } else if (status == CDI_AUDIO_STOP) {
+ // Stop playback
+ cdi_outb(dev->nabmbar + NABM_POCONTROL, 0x00);
+ }
+
+ // Returns whether the card is active or not
+ return cdi_inb(dev->nabmbar + NABM_POCONTROL) & 0x1;
+}
+
+void ac97_set_volume(struct cdi_audio_stream* stream, uint8_t volume)
+{
+ struct ac97_device* dev = ((struct ac97_stream*) stream)->device;
+
+ // Calculate the AC97 volume (which is 63 - (volume * 63 / 255))
+ int rvolume = volume * 63;
+ rvolume /= 255;
+
+ rvolume = 63 - rvolume;
+
+ // And set it
+ cdi_outw(dev->nambar + NAM_MASTER_VOLUME, (rvolume << 8) | rvolume);
+}
+
+int ac97_set_sample_rate(struct cdi_audio_stream* stream, int sample_rate)
+{
+ struct ac97_device* dev = ((struct ac97_stream*) stream)->device;
+
+ if (stream->fixed_sample_rate) {
+ // If the sample rate cannot be adjustet, return the fixed value
+ return stream->fixed_sample_rate;
+ }
+
+ if (sample_rate > 0) {
+ // Try to set the requested sample rate
+ cdi_outw(dev->nambar + NAM_FRONT_SPLRATE, sample_rate);
+ cdi_outw(dev->nambar + NAM_LR_SPLRATE, sample_rate);
+
+ cdi_sleep_ms(10);
+ }
+
+ // And return the actual rate set
+ return cdi_inw(dev->nambar + NAM_FRONT_SPLRATE);
+}
+
+void ac97_get_position(struct cdi_audio_stream* stream,
+ cdi_audio_position_t* position)
+{
+ struct ac97_device* dev = ((struct ac97_stream*) stream)->device;
+
+ position->buffer = cdi_inb(dev->nabmbar + NABM_POCIV);
+ // POPICB contains the number of samples not yet read from the buffer,
+ // we are required to return the number of frames played
+ position->frame =
+ (SAMPLES_PER_BUFFER - cdi_inw(dev->nabmbar + NABM_POPICB)) / 2;
+}
+
+int ac97_set_channel_count(struct cdi_audio_device* dev, int channels)
+{
+ (void) dev;
+ (void) channels;
+
+ // TODO: Is that really fixed or is there any way to use e.g. mono?
+ return 2;
+}
+
+static void ac97_isr(struct cdi_device* device)
+{
+ struct ac97_device* dev = ((struct ac97_card*) device)->device;
+ static int last_buf = 0;
+
+ int pi = cdi_inb(dev->nabmbar + NABM_PISTATUS) & 0x1C;
+ int po = cdi_inb(dev->nabmbar + NABM_POSTATUS) & 0x1C;
+ int mc = cdi_inb(dev->nabmbar + NABM_MCSTATUS) & 0x1C;
+
+ // Check if just anything happened
+ if (!pi && !po && !mc) {
+ return;
+ }
+
+ // Tell the card we handled everything (no, we don't, but who cares).
+ cdi_outb(dev->nabmbar + NABM_PISTATUS, pi);
+ cdi_outb(dev->nabmbar + NABM_POSTATUS, po);
+ cdi_outb(dev->nabmbar + NABM_MCSTATUS, mc);
+
+ if (po & (1 << 3)) {
+ int current = cdi_inb(dev->nabmbar + NABM_POCIV);
+
+ if (current == last_buf) {
+ // This happens sometimes, though I don't know why (for the last
+ // buffer, i.e. buffer 30). This fix is at least enough for qemu.
+ current = (current + 1) & 0x1F;
+ cdi_outb(dev->nabmbar + NABM_POCONTROL, 0x11);
+ }
+
+ last_buf = current;
+
+ // Tell the CDI library about the finished buffer
+ cdi_audio_buffer_completed(dev->output, (current - 1) & 0x1F);
+ }
+}
+
diff --git a/src/modules/cdi/ac97/device.h b/src/modules/cdi/ac97/device.h
new file mode 100644
index 0000000..823f545
--- /dev/null
+++ b/src/modules/cdi/ac97/device.h
@@ -0,0 +1,115 @@
+/******************************************************************************
+ * Copyright (c) 2010 Max Reitz *
+ * *
+ * Permission is hereby granted, free of charge, to any person obtaining a *
+ * copy of this software and associated documentation files (the "Software"), *
+ * to deal in the Software without restriction, including without limitation *
+ * the rights to use, copy, modify, merge, publish, distribute, sublicense, *
+ * and/or sell copies of the Software, and to permit persons to whom the *
+ * Software is furnished to do so, subject to the following conditions: *
+ * *
+ * The above copyright notice and this permission notice shall be included in *
+ * all copies or substantial portions of the Software. *
+ * *
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR *
+ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, *
+ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL *
+ * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER *
+ * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING *
+ * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER *
+ * DEALINGS IN THE SOFTWARE. *
+ ******************************************************************************/
+
+#ifndef DEVICE_H
+#define DEVICE_H
+
+#include <stddef.h>
+#include <stdint.h>
+
+#include "cdi.h"
+#include "cdi/audio.h"
+#include "cdi/mem.h"
+#include "cdi/pci.h"
+
+// Some I/O port offsets
+// NAMBAR
+#define NAM_RESET 0x0000
+#define NAM_MASTER_VOLUME 0x0002
+#define NAM_MONO_VOLUME 0x0006
+#define NAM_PC_BEEP 0x000A
+#define NAM_PCM_VOLUME 0x0018
+#define NAM_EXT_AUDIO_ID 0x0028
+#define NAM_EXT_AUDIO_STC 0x002A
+#define NAM_FRONT_SPLRATE 0x002C
+#define NAM_LR_SPLRATE 0x0032
+// NABMBAR
+#define NABM_POBDBAR 0x0010
+#define NABM_POCIV 0x0014
+#define NABM_POLVI 0x0015
+#define NABM_PISTATUS 0x0006
+#define NABM_POSTATUS 0x0016
+#define NABM_MCSTATUS 0x0026
+#define NABM_POPICB 0x0018
+#define NABM_PICONTROL 0x000B
+#define NABM_POCONTROL 0x001B
+#define NABM_MCCONTROL 0x002B
+#define NABM_GLB_STAT 0x0030
+
+// Buffer flags which may be set
+// Buffer underrun policy: If set, output 0 after the last sample, if there's no
+// new buffer; else, output the last sample.
+#define FLAG_BUP (1 << 14)
+// Interrupt on completion: Request an interrupt when having completed the
+// buffer
+#define FLAG_IOC (1 << 15)
+
+// A descriptor describing a buffer
+struct buf_desc
+{
+ // Physical address
+ uint32_t buffer;
+ // Number of samples contained
+ uint16_t length;
+ // Flags (BUP and/or IOC)
+ uint16_t flags;
+} __attribute__((packed));
+
+// A structure describing an AC97 card
+struct ac97_device {
+ // The two I/O spaces
+ uint16_t nambar, nabmbar;
+
+ // The buffer descriptor array
+ struct buf_desc* bd;
+ // The buffer's virtual addresses
+ void** vbd;
+
+ // Pointer to the output stream
+ struct cdi_audio_stream* output;
+};
+
+struct ac97_stream {
+ struct cdi_audio_stream stream;
+ struct ac97_device* device;
+};
+
+struct ac97_card {
+ struct cdi_audio_device card;
+ struct ac97_device* device;
+};
+
+struct cdi_device* ac97_init_device(struct cdi_bus_data* bus_data);
+void ac97_remove_device(struct cdi_device* device);
+
+int ac97_transfer_data(struct cdi_audio_stream* stream, size_t buffer,
+ struct cdi_mem_area* memory, size_t offset);
+cdi_audio_status_t ac97_change_status(struct cdi_audio_device* device,
+ cdi_audio_status_t status);
+void ac97_set_volume(struct cdi_audio_stream* stream, uint8_t volume);
+int ac97_set_sample_rate(struct cdi_audio_stream* stream, int sample_rate);
+void ac97_get_position(struct cdi_audio_stream* stream,
+ cdi_audio_position_t* position);
+int ac97_set_channel_count(struct cdi_audio_device* dev, int channels);
+
+#endif
+
diff --git a/src/modules/cdi/ac97/main.c b/src/modules/cdi/ac97/main.c
new file mode 100644
index 0000000..5afa557
--- /dev/null
+++ b/src/modules/cdi/ac97/main.c
@@ -0,0 +1,65 @@
+/******************************************************************************
+ * Copyright (c) 2010 Max Reitz *
+ * *
+ * Permission is hereby granted, free of charge, to any person obtaining a *
+ * copy of this software and associated documentation files (the "Software"), *
+ * to deal in the Software without restriction, including without limitation *
+ * the rights to use, copy, modify, merge, publish, distribute, sublicense, *
+ * and/or sell copies of the Software, and to permit persons to whom the *
+ * Software is furnished to do so, subject to the following conditions: *
+ * *
+ * The above copyright notice and this permission notice shall be included in *
+ * all copies or substantial portions of the Software. *
+ * *
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR *
+ * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY, *
+ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL *
+ * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER *
+ * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING *
+ * FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER *
+ * DEALINGS IN THE SOFTWARE. *
+ ******************************************************************************/
+
+#include "cdi/audio.h"
+
+#include "device.h"
+
+#define DRIVER_NAME "ac97"
+
+static struct cdi_audio_driver driver;
+
+static int ac97_driver_init(void)
+{
+ cdi_driver_init(&driver.drv);
+
+ return 0;
+}
+
+static int ac97_driver_destroy(void)
+{
+ cdi_driver_destroy(&driver.drv);
+
+ return 0;
+}
+
+static struct cdi_audio_driver driver = {
+ .drv = {
+ .name = DRIVER_NAME,
+ .type = CDI_AUDIO,
+ .bus = CDI_PCI,
+ .init = ac97_driver_init,
+ .destroy = ac97_driver_destroy,
+ .init_device = ac97_init_device,
+ .remove_device = ac97_remove_device
+ },
+
+ .transfer_data = ac97_transfer_data,
+ .change_device_status = ac97_change_status,
+ .set_volume = ac97_set_volume,
+ .set_sample_rate = ac97_set_sample_rate,
+ .get_position = ac97_get_position,
+ .set_number_of_channels = ac97_set_channel_count
+};
+
+CDI_DRIVER(DRIVER_NAME, driver)
+
--
1.7.1