minix3/drivers/audio/es1370/ak4531.c

178 lines
3.9 KiB
C

/* best viewed with tabsize 4 */
#include "ak4531.h"
#include "pci_helper.h"
#define MASTER_VOLUME_LCH 0x00
#define MASTER_VOLUME_RCH 0x01
#define FM_VOLUME_LCH 0x04
#define FM_VOLUME_RCH 0x05
#define CD_AUDIO_VOLUME_LCH 0x06
#define CD_AUDIO_VOLUME_RCH 0x07
#define LINE_VOLUME_LCH 0x08
#define LINE_VOLUME_RCH 0x09
#define MIC_VOLUME 0x0e
#define MONO_OUT_VOLUME 0x0f
#define RESET_AND_POWER_DOWN 0x16
#define PD 0x02
#define RST 0x01
#define AD_INPUT_SELECT 0x18
#define MIC_AMP_GAIN 0x19
#define MUTE 0x80
static int ak4531_write(u8_t address, u8_t data);
static int ak4531_finished(void);
static int set_volume(struct volume_level *level, int cmd_left, int
cmd_right, int max_level);
static u16_t base_address;
static u16_t status_register;
static u16_t status_bit;
static u16_t poll_address;
u8_t mixer_values[0x20] = {
0x08, 0x08, 0x08, 0x08, 0x08, 0x08, 0x08, 0x08, /* 0x00 - 0x07 */
0x08, 0x08, 0x08, 0x08, 0x08, 0x08, 0x00, 0x08, /* 0x08 - 0x0f */
0x7e, 0x3d, 0x01, 0x01, 0x00, 0x00, 0x03, 0x00, /* 0x10 - 0x17 */
0x00, 0x01 /* 0x18 - 0x19 */
};
#if 0
u8_t mixer_values[0x20] = {
0x08, 0x08, 0x08, 0x08, 0x08, 0x08, 0x08, 0x08, /* 0x00 - 0x07 */
0x08, 0x08, 0x08, 0x08, 0x08, 0x08, 0x08, 0x08, /* 0x08 - 0x0f */
0x7f, 0x3d, 0x55, 0x26, 0xf7, 0xef, 0x03, 0x00, /* 0x10 - 0x17 */
0x00, 0x01 /* 0x18 - 0x19 */
};
#endif
static int ak4531_finished(void) {
int i;
u16_t cstat;
for (i = 0; i < 0x40000; i++) {
cstat = pci_inw(status_register);
if (!(cstat & status_bit)) {
return 1;
}
}
return 0;
}
static int ak4531_write (u8_t address, u8_t data) {
u16_t to_be_written;
if (address > MIC_AMP_GAIN) return -1;
to_be_written = (u16_t)((address << 8) | data);
if (!ak4531_finished()) return -1;
pci_outw(base_address, to_be_written);
return 0;
}
int ak4531_init(u16_t base, u16_t status_reg, u16_t bit,
u16_t poll) {
int i;
base_address = base;
status_register = status_reg;
status_bit = bit;
poll_address = poll;
for (i=0; i<100; i++) {
pci_inb(poll_address);
}
if(ak4531_write(RESET_AND_POWER_DOWN, PD|RST) < 0) return -1;
for (i=0; i<100; i++) {
pci_inb(poll_address);
}
ak4531_write(AD_INPUT_SELECT, 0x00);
for (i = MASTER_VOLUME_LCH ; i <= MIC_AMP_GAIN; i++) {
if (ak4531_write(i, mixer_values[i]) < 0) return -1;
}
return 0;
}
int ak4531_get_set_volume(struct volume_level *level, int flag) {
int cmd_left, cmd_right, max_level;
max_level = 0x1f;
switch(level->device) {
case Master:
cmd_left = MASTER_VOLUME_LCH;
cmd_right = MASTER_VOLUME_RCH;
break;
case Dac:
return EINVAL;
break;
case Fm:
cmd_left = FM_VOLUME_LCH;
cmd_right = FM_VOLUME_RCH;
break;
case Cd:
cmd_left = CD_AUDIO_VOLUME_LCH;
cmd_right = CD_AUDIO_VOLUME_RCH;
break;
case Line:
cmd_left = LINE_VOLUME_LCH;
cmd_right = LINE_VOLUME_RCH;
break;
case Mic:
cmd_left = cmd_right = MIC_VOLUME;
break;
case Speaker:
cmd_left = cmd_right = MONO_OUT_VOLUME;
max_level = 0x03;
break;
case Treble:
return EINVAL;
break;
case Bass:
return EINVAL;
break;
default:
return EINVAL;
}
if (flag) { /* set volume */
return set_volume(level, cmd_left, cmd_right, max_level);
}
else { /* get volume */
level->left = - ((int) (mixer_values[cmd_left] & ~MUTE)) + 0x1f;
level->right = - ((int) (mixer_values[cmd_right] & ~MUTE)) + 0x1f;
return OK;
}
}
static int set_volume(struct volume_level *level, int cmd_left, int cmd_right,
int max_level) {
if(level->right < 0) level->right = 0;
else if(level->right > max_level) level->right = max_level;
if(level->left < 0) level->left = 0;
else if(level->left > max_level) level->left = max_level;
mixer_values[cmd_left] = (-level->left)+0x1f;
ak4531_write(cmd_left, mixer_values[cmd_left]);
mixer_values[cmd_right] = (-level->right)+0x1f;
ak4531_write(cmd_right, mixer_values[cmd_right]);
return OK;
}