ALSA: riptide - Code clean up

A code clean up, coding style fixes.
The firmware loading routine is split to an own function to improve
the readability.

Signed-off-by: Takashi Iwai <tiwai@suse.de>
This commit is contained in:
Takashi Iwai 2009-05-26 12:58:58 +02:00
parent 59a3759d0f
commit a693a26fe0
1 changed files with 134 additions and 152 deletions

View File

@ -507,41 +507,19 @@ static int riptide_reset(struct cmdif *cif, struct snd_riptide *chip);
*/
static struct pci_device_id snd_riptide_ids[] = {
{
.vendor = 0x127a,.device = 0x4310,
.subvendor = PCI_ANY_ID,.subdevice = PCI_ANY_ID,
},
{
.vendor = 0x127a,.device = 0x4320,
.subvendor = PCI_ANY_ID,.subdevice = PCI_ANY_ID,
},
{
.vendor = 0x127a,.device = 0x4330,
.subvendor = PCI_ANY_ID,.subdevice = PCI_ANY_ID,
},
{
.vendor = 0x127a,.device = 0x4340,
.subvendor = PCI_ANY_ID,.subdevice = PCI_ANY_ID,
},
{ PCI_DEVICE(0x127a, 0x4310) },
{ PCI_DEVICE(0x127a, 0x4320) },
{ PCI_DEVICE(0x127a, 0x4330) },
{ PCI_DEVICE(0x127a, 0x4340) },
{0,},
};
#ifdef SUPPORT_JOYSTICK
static struct pci_device_id snd_riptide_joystick_ids[] __devinitdata = {
{
.vendor = 0x127a,.device = 0x4312,
.subvendor = PCI_ANY_ID,.subdevice = PCI_ANY_ID,
},
{
.vendor = 0x127a,.device = 0x4322,
.subvendor = PCI_ANY_ID,.subdevice = PCI_ANY_ID,
},
{.vendor = 0x127a,.device = 0x4332,
.subvendor = PCI_ANY_ID,.subdevice = PCI_ANY_ID,
},
{.vendor = 0x127a,.device = 0x4342,
.subvendor = PCI_ANY_ID,.subdevice = PCI_ANY_ID,
},
{ PCI_DEVICE(0x127a, 0x4312) },
{ PCI_DEVICE(0x127a, 0x4322) },
{ PCI_DEVICE(0x127a, 0x4332) },
{ PCI_DEVICE(0x127a, 0x4342) },
{0,},
};
#endif
@ -1209,12 +1187,79 @@ static int riptide_resume(struct pci_dev *pci)
}
#endif
static int try_to_load_firmware(struct cmdif *cif, struct snd_riptide *chip)
{
union firmware_version firmware = { .ret = CMDRET_ZERO };
int i, timeout, err;
for (i = 0; i < 2; i++) {
WRITE_PORT_ULONG(cif->hwport->port[i].data1, 0);
WRITE_PORT_ULONG(cif->hwport->port[i].data2, 0);
}
SET_GRESET(cif->hwport);
udelay(100);
UNSET_GRESET(cif->hwport);
udelay(100);
for (timeout = 100000; --timeout; udelay(10)) {
if (IS_READY(cif->hwport) && !IS_GERR(cif->hwport))
break;
}
if (!timeout) {
snd_printk(KERN_ERR
"Riptide: device not ready, audio status: 0x%x "
"ready: %d gerr: %d\n",
READ_AUDIO_STATUS(cif->hwport),
IS_READY(cif->hwport), IS_GERR(cif->hwport));
return -EIO;
} else {
snd_printdd
("Riptide: audio status: 0x%x ready: %d gerr: %d\n",
READ_AUDIO_STATUS(cif->hwport),
IS_READY(cif->hwport), IS_GERR(cif->hwport));
}
SEND_GETV(cif, &firmware.ret);
snd_printdd("Firmware version: ASIC: %d CODEC %d AUXDSP %d PROG %d\n",
firmware.firmware.ASIC, firmware.firmware.CODEC,
firmware.firmware.AUXDSP, firmware.firmware.PROG);
for (i = 0; i < FIRMWARE_VERSIONS; i++) {
if (!memcmp(&firmware_versions[i], &firmware, sizeof(firmware)))
break;
}
if (i >= FIRMWARE_VERSIONS)
return 0; /* no match */
if (!chip)
return 1; /* OK */
snd_printdd("Writing Firmware\n");
if (!chip->fw_entry) {
err = request_firmware(&chip->fw_entry, "riptide.hex",
&chip->pci->dev);
if (err) {
snd_printk(KERN_ERR
"Riptide: Firmware not available %d\n", err);
return -EIO;
}
}
err = loadfirmware(cif, chip->fw_entry->data, chip->fw_entry->size);
if (err) {
snd_printk(KERN_ERR
"Riptide: Could not load firmware %d\n", err);
return err;
}
chip->firmware = firmware;
return 1; /* OK */
}
static int riptide_reset(struct cmdif *cif, struct snd_riptide *chip)
{
int timeout, tries;
union cmdret rptr = CMDRET_ZERO;
union firmware_version firmware;
int i, j, err, has_firmware;
int err, tries;
if (!cif)
return -EINVAL;
@ -1227,75 +1272,11 @@ static int riptide_reset(struct cmdif *cif, struct snd_riptide *chip)
cif->is_reset = 0;
tries = RESET_TRIES;
has_firmware = 0;
while (has_firmware == 0 && tries-- > 0) {
for (i = 0; i < 2; i++) {
WRITE_PORT_ULONG(cif->hwport->port[i].data1, 0);
WRITE_PORT_ULONG(cif->hwport->port[i].data2, 0);
}
SET_GRESET(cif->hwport);
udelay(100);
UNSET_GRESET(cif->hwport);
udelay(100);
for (timeout = 100000; --timeout; udelay(10)) {
if (IS_READY(cif->hwport) && !IS_GERR(cif->hwport))
break;
}
if (timeout == 0) {
snd_printk(KERN_ERR
"Riptide: device not ready, audio status: 0x%x ready: %d gerr: %d\n",
READ_AUDIO_STATUS(cif->hwport),
IS_READY(cif->hwport), IS_GERR(cif->hwport));
return -EIO;
} else {
snd_printdd
("Riptide: audio status: 0x%x ready: %d gerr: %d\n",
READ_AUDIO_STATUS(cif->hwport),
IS_READY(cif->hwport), IS_GERR(cif->hwport));
}
SEND_GETV(cif, &rptr);
for (i = 0; i < 4; i++)
firmware.ret.retwords[i] = rptr.retwords[i];
snd_printdd
("Firmware version: ASIC: %d CODEC %d AUXDSP %d PROG %d\n",
firmware.firmware.ASIC, firmware.firmware.CODEC,
firmware.firmware.AUXDSP, firmware.firmware.PROG);
for (j = 0; j < FIRMWARE_VERSIONS; j++) {
has_firmware = 1;
for (i = 0; i < 4; i++) {
if (firmware_versions[j].ret.retwords[i] !=
firmware.ret.retwords[i])
has_firmware = 0;
}
if (has_firmware)
break;
}
if (chip != NULL && has_firmware == 0) {
snd_printdd("Writing Firmware\n");
if (!chip->fw_entry) {
if ((err =
request_firmware(&chip->fw_entry,
"riptide.hex",
&chip->pci->dev)) != 0) {
snd_printk(KERN_ERR
"Riptide: Firmware not available %d\n",
err);
return -EIO;
}
}
err = loadfirmware(cif, chip->fw_entry->data,
chip->fw_entry->size);
if (err)
snd_printk(KERN_ERR
"Riptide: Could not load firmware %d\n",
err);
}
}
do {
err = try_to_load_firmware(cif, chip);
if (err < 0)
return err;
} while (!err && --tries);
SEND_SACR(cif, 0, AC97_RESET);
SEND_RACR(cif, AC97_RESET, &rptr);
@ -1337,11 +1318,6 @@ static int riptide_reset(struct cmdif *cif, struct snd_riptide *chip)
SET_AIE(cif->hwport);
SET_AIACK(cif->hwport);
cif->is_reset = 1;
if (chip) {
for (i = 0; i < 4; i++)
chip->firmware.ret.retwords[i] =
firmware.ret.retwords[i];
}
return 0;
}
@ -2094,8 +2070,8 @@ snd_card_riptide_probe(struct pci_dev *pci, const struct pci_device_id *pci_id)
static int dev;
struct snd_card *card;
struct snd_riptide *chip;
unsigned short addr;
int err = 0;
unsigned short val;
int err;
if (dev >= SNDRV_CARDS)
return -ENODEV;
@ -2107,60 +2083,63 @@ snd_card_riptide_probe(struct pci_dev *pci, const struct pci_device_id *pci_id)
err = snd_card_create(index[dev], id[dev], THIS_MODULE, 0, &card);
if (err < 0)
return err;
if ((err = snd_riptide_create(card, pci, &chip)) < 0) {
snd_card_free(card);
return err;
}
err = snd_riptide_create(card, pci, &chip);
if (err < 0)
goto error;
card->private_data = chip;
if ((err = snd_riptide_pcm(chip, 0, NULL)) < 0) {
snd_card_free(card);
return err;
}
if ((err = snd_riptide_mixer(chip)) < 0) {
snd_card_free(card);
return err;
}
pci_write_config_word(chip->pci, PCI_EXT_Legacy_Mask, LEGACY_ENABLE_ALL
| (opl3_port[dev] ? LEGACY_ENABLE_FM : 0)
err = snd_riptide_pcm(chip, 0, NULL);
if (err < 0)
goto error;
err = snd_riptide_mixer(chip);
if (err < 0)
goto error;
val = LEGACY_ENABLE_ALL;
if (opl3_port[dev])
val |= LEGACY_ENABLE_FM;
#ifdef SUPPORT_JOYSTICK
| (joystick_port[dev] ? LEGACY_ENABLE_GAMEPORT :
0)
if (joystick_port[dev])
val |= LEGACY_ENABLE_GAMEPORT;
#endif
| (mpu_port[dev]
? (LEGACY_ENABLE_MPU_INT | LEGACY_ENABLE_MPU) :
0)
| ((chip->irq << 4) & 0xF0));
if ((addr = mpu_port[dev]) != 0) {
pci_write_config_word(chip->pci, PCI_EXT_MPU_Base, addr);
if ((err = snd_mpu401_uart_new(card, 0, MPU401_HW_RIPTIDE,
addr, 0, chip->irq, 0,
&chip->rmidi)) < 0)
if (mpu_port[dev])
val |= LEGACY_ENABLE_MPU_INT | LEGACY_ENABLE_MPU;
val |= (chip->irq << 4) & 0xf0;
pci_write_config_word(chip->pci, PCI_EXT_Legacy_Mask, val);
if (mpu_port[dev]) {
val = mpu_port[dev];
pci_write_config_word(chip->pci, PCI_EXT_MPU_Base, val);
err = snd_mpu401_uart_new(card, 0, MPU401_HW_RIPTIDE,
val, 0, chip->irq, 0,
&chip->rmidi);
if (err < 0)
snd_printk(KERN_WARNING
"Riptide: Can't Allocate MPU at 0x%x\n",
addr);
val);
else
chip->mpuaddr = addr;
chip->mpuaddr = val;
}
if ((addr = opl3_port[dev]) != 0) {
pci_write_config_word(chip->pci, PCI_EXT_FM_Base, addr);
if ((err = snd_opl3_create(card, addr, addr + 2,
OPL3_HW_RIPTIDE, 0,
&chip->opl3)) < 0)
if (opl3_port[dev]) {
val = opl3_port[dev];
pci_write_config_word(chip->pci, PCI_EXT_FM_Base, val);
err = snd_opl3_create(card, val, val + 2,
OPL3_HW_RIPTIDE, 0, &chip->opl3);
if (err < 0)
snd_printk(KERN_WARNING
"Riptide: Can't Allocate OPL3 at 0x%x\n",
addr);
val);
else {
chip->opladdr = addr;
if ((err =
snd_opl3_hwdep_new(chip->opl3, 0, 1, NULL)) < 0)
chip->opladdr = val;
err = snd_opl3_hwdep_new(chip->opl3, 0, 1, NULL);
if (err < 0)
snd_printk(KERN_WARNING
"Riptide: Can't Allocate OPL3-HWDEP\n");
}
}
#ifdef SUPPORT_JOYSTICK
if ((addr = joystick_port[dev]) != 0) {
pci_write_config_word(chip->pci, PCI_EXT_Game_Base, addr);
chip->gameaddr = addr;
if (joystick_port[dev]) {
val = joystick_port[dev];
pci_write_config_word(chip->pci, PCI_EXT_Game_Base, val);
chip->gameaddr = val;
}
#endif
@ -2178,13 +2157,16 @@ snd_card_riptide_probe(struct pci_dev *pci, const struct pci_device_id *pci_id)
chip->opladdr);
#endif
snd_riptide_proc_init(chip);
if ((err = snd_card_register(card)) < 0) {
snd_card_free(card);
return err;
}
err = snd_card_register(card);
if (err < 0)
goto error;
pci_set_drvdata(pci, card);
dev++;
return 0;
error:
snd_card_free(card);
return err;
}
static void __devexit snd_card_riptide_remove(struct pci_dev *pci)