static int __devinit pm8xxx_spk_probe(struct platform_device *pdev) { const struct pm8xxx_spk_platform_data *pdata = pdev->dev.platform_data; int ret = 0; if (!pdata) { pr_err("missing platform data\n"); return -EINVAL; } the_spk_chip = kzalloc(sizeof(struct pm8xxx_spk_chip), GFP_KERNEL); if (the_spk_chip == NULL) { pr_err("kzalloc() failed.\n"); return -ENOMEM; } mutex_init(&the_spk_chip->spk_mutex); the_spk_chip->dev = &pdev->dev; the_spk_chip->version = pm8xxx_get_version(the_spk_chip->dev->parent); switch (pm8xxx_get_version(the_spk_chip->dev->parent)) { case PM8XXX_VERSION_8038: break; default: ret = -ENODEV; goto err_handle; } memcpy(&(the_spk_chip->pdata), pdata, sizeof(struct pm8xxx_spk_platform_data)); the_spk_chip->base = pdev->resource[0].start; the_spk_chip->end = pdev->resource[0].end; if (the_spk_chip->pdata.spk_add_enable) { int val; val = pm8xxx_spk_read(PM8XXX_SPK_CTL1_REG_OFF); if (val < 0) { ret = val; goto err_handle; } val |= (the_spk_chip->pdata.spk_add_enable & PM8XXX_ADD_EN); ret = pm8xxx_spk_write(PM8XXX_SPK_CTL1_REG_OFF, val); if (ret < 0) goto err_handle; } return pm8xxx_spk_config(); err_handle: pr_err("pm8xxx_spk_probe failed." "Audio unavailable on speaker.\n"); mutex_destroy(&the_spk_chip->spk_mutex); kfree(the_spk_chip); return ret; }
int pm8xxx_spk_mute(bool mute) { u8 val = 0; int ret = 0; if (spk_defined() == false) { pr_err("Invalid spk handle or no spk_chip\n"); return -ENODEV; } val = pm8xxx_spk_read(PM8XXX_SPK_CTL1_REG_OFF); val |= mute << 2; ret = pm8xxx_spk_write(PM8XXX_SPK_CTL1_REG_OFF, val); return ret; }
int pm8xxx_spk_gain(u8 gain) { u8 val; int ret = 0; if (spk_defined() == false) { pr_err("Invalid spk handle or no spk_chip\n"); return -ENODEV; } val = pm8xxx_spk_read(PM8XXX_SPK_CTL1_REG_OFF); val = (gain << 4) | (val & 0xF); ret = pm8xxx_spk_write(PM8XXX_SPK_CTL1_REG_OFF, val); if (!ret) { pm8xxx_spk_bank_write(the_spk_chip->base + PM8XXX_SPK_TEST_REG_1_OFF, 0, BOOST_6DB_GAIN_EN_MASK | VSEL_LD0_1P2); } return ret; }
int pm8xxx_spk_enable(int enable) { int val = 0; u16 addr; int ret = 0; if (spk_defined() == false) { pr_err("Invalid spk handle or no spk_chip\n"); return -ENODEV; } addr = the_spk_chip->base + PM8XXX_SPK_TEST_REG_1_OFF; val = pm8xxx_spk_read(PM8XXX_SPK_CTL1_REG_OFF); if (val < 0) return val; if (enable) val |= (1 << 3); else val &= ~(1 << 3); ret = pm8xxx_spk_write(PM8XXX_SPK_CTL1_REG_OFF, val); if (!ret) ret = pm8xxx_spk_bank_write(addr, 6, PWM_EN_MASK); return ret; }
static int __devinit pm8xxx_spk_probe(struct platform_device *pdev) { const struct pm8xxx_spk_platform_data *pdata = pdev->dev.platform_data; int ret = 0; u8 value = 0; if (!pdata) { pr_err("missing platform data\n"); return -EINVAL; } the_spk_chip = kzalloc(sizeof(struct pm8xxx_spk_chip), GFP_KERNEL); if (the_spk_chip == NULL) { pr_err("kzalloc() failed.\n"); return -ENOMEM; } mutex_init(&the_spk_chip->spk_mutex); the_spk_chip->dev = &pdev->dev; the_spk_chip->version = pm8xxx_get_version(the_spk_chip->dev->parent); switch (pm8xxx_get_version(the_spk_chip->dev->parent)) { case PM8XXX_VERSION_8038: break; default: ret = -ENODEV; goto err_handle; } memcpy(&(the_spk_chip->pdata), pdata, sizeof(struct pm8xxx_spk_platform_data)); the_spk_chip->base = pdev->resource[0].start; the_spk_chip->end = pdev->resource[0].end; if (the_spk_chip->pdata.spk_add_enable) { int val; val = pm8xxx_spk_read(PM8XXX_SPK_CTL1_REG_OFF); if (val < 0) { ret = val; goto err_handle; } val |= (the_spk_chip->pdata.spk_add_enable & PM8XXX_ADD_EN); ret = pm8xxx_spk_write(PM8XXX_SPK_CTL1_REG_OFF, val); if (ret < 0) goto err_handle; } value = ((the_spk_chip->pdata.cd_ng_threshold << 5) | the_spk_chip->pdata.cd_nf_preamp_bias << 3); pr_debug("Setting SPK_CTL2_REG = %02x\n", value); pm8xxx_spk_write(PM8XXX_SPK_CTL2_REG_OFF, value); value = ((the_spk_chip->pdata.cd_ng_hold << 5) | (the_spk_chip->pdata.cd_ng_max_atten << 1) | the_spk_chip->pdata.noise_mute); pr_debug("Setting SPK_CTL3_REG = %02x\n", value); pm8xxx_spk_write(PM8XXX_SPK_CTL3_REG_OFF, value); value = ((the_spk_chip->pdata.cd_ng_decay_rate << 5) | (the_spk_chip->pdata.cd_ng_attack_rate << 3) | the_spk_chip->pdata.cd_delay << 2); pr_debug("Setting SPK_CTL4_REG = %02x\n", value); pm8xxx_spk_write(PM8XXX_SPK_CTL4_REG_OFF, value); return pm8xxx_spk_config(); err_handle: pr_err("pm8xxx_spk_probe failed." "Audio unavailable on speaker.\n"); mutex_destroy(&the_spk_chip->spk_mutex); kfree(the_spk_chip); return ret; }