Changeset b3f36d2 in mainline

Timestamp:

2011-09-26T09:55:27Z (13 years ago)

Author:

Jan Vesely <jano.vesely@…>

Branches:

lfn, master, serial, ticket/834-toolchain-update, topic/msim-upgrade, topic/simplify-dev-export

Children:

c7325dd6

Parents:

b1926d0

Message:

sb16: Implement volume get/set. Make master the first volume item.

File:

• uspace/drv/audio/sb16/mixer.c (modified) (2 diffs)

uspace/drv/audio/sb16/mixer.c

@@ -53 +53 @@
 
 static const volume_item_t volume_ct1345[] = {
+        { 0x22, 2, "Master", 8, 1, true },
         { 0x04, 2, "Voice", 8, 1, true },
         { 0x0a, 1, "Mic", 4, 1, true },
-        { 0x22, 2, "Master", 8, 1, true },
         { 0x26, 2, "MIDI", 8, 1, true },
         { 0x28, 2, "CD", 8, 1, true },
@@ -143 +143 @@
 /*----------------------------------------------------------------------------*/
 int mixer_set_volume_level(sb16_regs_t *regs, mixer_type_t type,
-    unsigned item, unsigned channel, unsigned level)
+    unsigned index, unsigned channel, unsigned level)
 {
-        return ENOTSUP;
+        if (type == SB_MIXER_UNKNOWN || type == SB_MIXER_NONE)
+                return ENOTSUP;
+        if (index >= volume_table[type].count)
+                return ENOENT;
+        if (level >= volume_table[type].table[index].volume_levels)
+                return ENOTSUP;
+        if (channel >= volume_table[type].table[index].channels)
+                return ENOENT;
+
+        const volume_item_t item = volume_table[type].table[index];
+        const uint8_t address = item.address + (item.same_reg ? 0 : channel);
+        pio_write_8(&regs->mixer_address, address);
+        if (!item.same_reg) {
+                const uint8_t value = level << item.shift;
+                pio_write_8(&regs->mixer_data, value);
+        } else {
+                /* Nasty stuff */
+                uint8_t value = pio_read_8(&regs->mixer_data);
+                /* Remove value that is to be replaced register format is L:R*/
+                value &= (channel ? 0xf0 : 0x0f);
+                /* Add the new value */
+                value |= (level << item.shift) << (channel ? 0 : 4);
+                pio_write_8(&regs->mixer_data, value);
+        }
+        return EOK;
 }
 /*----------------------------------------------------------------------------*/
 unsigned mixer_get_volume_level(sb16_regs_t *regs, mixer_type_t type,
-    unsigned item, unsigned channel)
+    unsigned index, unsigned channel)
 {
+        if (type == SB_MIXER_UNKNOWN
+            || type == SB_MIXER_NONE
+            || (index >= volume_table[type].count)
+            || (channel >= volume_table[type].table[index].channels))
+                return 0;
+
+        const volume_item_t item = volume_table[type].table[index];
+        const uint8_t address = item.address + (item.same_reg ? 0 : channel);
+        pio_write_8(&regs->mixer_address, address);
+        if (!item.same_reg) {
+                return pio_read_8(&regs->mixer_data) >> item.shift;
+        } else {
+                const uint8_t value =
+                    pio_read_8(&regs->mixer_data) >> (channel ? 0 : 4);
+                return value >> item.shift;
+        }
         return 0;
 }