// SPDX-License-Identifier: GPL-2.0 /* * Copyright (c) 2019 Awinic Inc. */ #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include #include /*(LINUX_VERSION_CODE >= KERNEL_VERSION(3, 19, 0)) */ #include #include #include #include #include #include /******************************************************************************* * aw87519 marco ******************************************************************************/ #define AW87519_RIGHT_I2C_NAME "AW87519_RIGHT_PA" #define AW87519_RIGHT_DRIVER_VERSION "v1.0.1" static unsigned char aw87519_spk_cfg_default[] = { 0x01, 0xF0, 0x02, 0x09, 0x03, 0xE8, 0x04, 0x11, 0x05, 0x10, 0x06, 0x43, 0x07, 0x4E, 0x08, 0x03, 0x09, 0x08, 0x0A, 0x4A, 0x60, 0x16, 0x61, 0x20, 0x62, 0x01, 0x63, 0x0B, 0x64, 0xC5, 0x65, 0xA4, 0x66, 0x78, 0x67, 0xC4, 0x68, 0XD0 }; static unsigned char aw87519_rcv_cfg_default[] = { 0x01, 0xF8, 0x02, 0x09, 0x03, 0xC8, 0x04, 0x11, 0x05, 0x05, 0x06, 0x53, 0x07, 0x4E, 0x08, 0x0B, 0x09, 0x08, 0x0A, 0x4B, 0x60, 0x16, 0x61, 0x20, 0x62, 0x01, 0x63, 0x0B, 0x64, 0xC5, 0x65, 0xA4, 0x66, 0x78, 0x67, 0xC4, 0x68, 0XD0 }; struct aw87519_container { int len; unsigned char data[]; }; struct aw87519 { struct i2c_client *i2c_client; int reset_gpio; unsigned char hwen_flag; unsigned char spk_cfg_update_flag; unsigned char rcv_cfg_update_flag; unsigned char spk_cfg_data[sizeof(aw87519_spk_cfg_default) / sizeof(char)]; unsigned char rcv_cfg_data[sizeof(aw87519_rcv_cfg_default) / sizeof(char)]; struct hrtimer cfg_timer; struct mutex cfg_lock; struct work_struct cfg_work; struct delayed_work ram_work; }; /******************************************************************************* * aw87519 variable ******************************************************************************/ static struct aw87519 *aw87519; static struct aw87519_container *aw87519_spk_cnt; static struct aw87519_container *aw87519_rcv_cnt; static char *aw87519_spk_name = "aw87519_right_spk.bin"; static char *aw87519_rcv_name = "aw87519_right_rcv.bin"; /******************************************************************************* * i2c write and read ******************************************************************************/ static int aw87519_i2c_write(struct aw87519 *aw87519, unsigned char reg_addr, unsigned char reg_data) { int ret = -1; unsigned char cnt = 0; while (cnt < AW_I2C_RETRIES) { ret = i2c_smbus_write_byte_data(aw87519->i2c_client, reg_addr, reg_data); if (ret < 0) pr_err("%s: i2c_write cnt=%d error=%d\n", __func__, cnt, ret); else break; cnt++; msleep(AW_I2C_RETRY_DELAY); } return ret; } static int aw87519_i2c_read(struct aw87519 *aw87519, unsigned char reg_addr, unsigned char *reg_data) { int ret = -1; unsigned char cnt = 0; while (cnt < AW_I2C_RETRIES) { ret = i2c_smbus_read_byte_data(aw87519->i2c_client, reg_addr); if (ret < 0) { pr_err("%s: i2c_read cnt=%d error=%d\n", __func__, cnt, ret); } else { *reg_data = ret; break; } cnt++; msleep(AW_I2C_RETRY_DELAY); } return ret; } /******************************************************************************* * aw87519 hardware control ******************************************************************************/ static unsigned int aw87519_hw_on(struct aw87519 *aw87519) { pr_info("%s right enter\n", __func__); if (aw87519 && gpio_is_valid(aw87519->reset_gpio)) { gpio_set_value_cansleep(aw87519->reset_gpio, 0); usleep_range(2000, 2500); gpio_set_value_cansleep(aw87519->reset_gpio, 1); usleep_range(2000, 2500); aw87519->hwen_flag = 1; aw87519_i2c_write(aw87519, 0x64, 0x2C); } else { dev_err(&aw87519->i2c_client->dev, "%s: failed\n", __func__); } return 0; } static unsigned int aw87519_hw_off(struct aw87519 *aw87519) { pr_info("%s enter\n", __func__); if (aw87519 && gpio_is_valid(aw87519->reset_gpio)) { gpio_set_value_cansleep(aw87519->reset_gpio, 0); usleep_range(2000, 2500); aw87519->hwen_flag = 0; } else { dev_err(&aw87519->i2c_client->dev, "%s: failed\n", __func__); } return 0; } /******************************************************************************* * aw87519 control interface ******************************************************************************/ unsigned char aw87519_right_audio_receiver(void) { unsigned int i; unsigned int length; if (aw87519 == NULL) return 2; if (!aw87519->hwen_flag) aw87519_hw_on(aw87519); aw87519_i2c_write(aw87519, 0x69, 0x80); aw87519_i2c_write(aw87519, 0x69, 0xB7); length = sizeof(aw87519_spk_cfg_default) / sizeof(char); if (aw87519->rcv_cfg_update_flag == 0) { /*update array data */ for (i = 0; i < length; i = i + 2) { aw87519_i2c_write(aw87519, aw87519_rcv_cfg_default[i], aw87519_rcv_cfg_default[i + 1]); } } if (aw87519->rcv_cfg_update_flag == 1) { /*update bin data */ for (i = 0; i < length; i = i + 2) { aw87519_i2c_write(aw87519, aw87519->rcv_cfg_data[i], aw87519->rcv_cfg_data[i + 1]); } } return 0; } unsigned char aw87519_amp_rch_on(void) { unsigned int i; unsigned int length; pr_info("%s enter\n", __func__); if (aw87519 == NULL) return 2; if (!aw87519->hwen_flag) aw87519_hw_on(aw87519); aw87519_i2c_write(aw87519, 0x69, 0x80); aw87519_i2c_write(aw87519, 0x69, 0xB7); length = sizeof(aw87519_spk_cfg_default) / sizeof(char); if (aw87519->spk_cfg_update_flag == 0) { /*send array data */ for (i = 0; i < length; i = i + 2) { aw87519_i2c_write(aw87519, aw87519_spk_cfg_default[i], aw87519_spk_cfg_default[i + 1]); } } if (aw87519->spk_cfg_update_flag == 1) { /*send bin data */ for (i = 0; i < length; i = i + 2) { aw87519_i2c_write(aw87519, aw87519->spk_cfg_data[i], aw87519->spk_cfg_data[i + 1]); } } return 0; } unsigned char aw87519_amp_rch_off(void) { pr_info("%s enter\n", __func__); if (aw87519 == NULL) return 2; if (aw87519->hwen_flag) aw87519_i2c_write(aw87519, 0x01, 0x00); /*CHIP Disable*/ aw87519_hw_off(aw87519); return 0; } /******************************************************************************* * aw87519 firmware cfg update ******************************************************************************/ static void aw87519_receiver_cfg_loaded(const struct firmware *cont, void *context) { int i = 0; pr_info("%s enter\n", __func__); if (!cont) { pr_err("%s: failed to read %s\n", __func__, aw87519_rcv_name); release_firmware(cont); return; } pr_info("%s: loaded %s - size: %zu\n", __func__, aw87519_rcv_name, cont ? cont->size : 0); for (i = 0; i < cont->size; i++) pr_info("%s: addr:0x%04x, data:0x%02x\n", __func__, i, *(cont->data + i)); /* aw87519 ram update */ aw87519_rcv_cnt = kzalloc(cont->size + sizeof(int), GFP_KERNEL); if (!aw87519_rcv_cnt) { release_firmware(cont); pr_err("%s: Error allocating memory\n", __func__); return; } aw87519_rcv_cnt->len = cont->size; for (i = 0; i < aw87519_rcv_cnt->len; i++) aw87519->rcv_cfg_data[i] = *(cont->data + i); release_firmware(cont); kfree(aw87519_rcv_cnt); pr_info("%s: fw update complete\n", __func__); } static int aw87519_rcv_update(struct aw87519 *aw87519) { pr_info("%s enter\n", __func__); return request_firmware_nowait(THIS_MODULE, FW_ACTION_HOTPLUG, aw87519_rcv_name, &aw87519->i2c_client->dev, GFP_KERNEL, aw87519, aw87519_receiver_cfg_loaded); } static void aw87519_speaker_cfg_loaded(const struct firmware *cont, void *context) { int i = 0; pr_info("%s enter\n", __func__); if (!cont) { pr_err("%s: failed to read %s\n", __func__, aw87519_spk_name); release_firmware(cont); return; } pr_info("%s: loaded %s - size: %zu\n", __func__, aw87519_spk_name, cont ? cont->size : 0); for (i = 0; i < cont->size; i++) pr_info("%s: addr:0x%04x, data:0x%02x\n", __func__, i, *(cont->data + i)); /* aw87519 ram update */ aw87519_spk_cnt = kzalloc(cont->size + sizeof(int), GFP_KERNEL); if (!aw87519_spk_cnt) { release_firmware(cont); pr_err("%s: Error allocating memory\n", __func__); return; } aw87519_spk_cnt->len = cont->size; for (i = 0; i < aw87519_spk_cnt->len; i++) aw87519->spk_cfg_data[i] = *(cont->data + i); release_firmware(cont); kfree(aw87519_spk_cnt); pr_info("%s: fw update complete\n", __func__); aw87519_rcv_update(aw87519); } #ifdef AWINIC_CFG_UPDATE_DELAY static int aw87519_cfg_update(struct aw87519 *aw87519) { pr_info("%s enter\n", __func__); return request_firmware_nowait(THIS_MODULE, FW_ACTION_HOTPLUG, aw87519_spk_name, &aw87519->i2c_client->dev, GFP_KERNEL, aw87519, aw87519_speaker_cfg_loaded); } static void aw87519_cfg_work_routine(struct work_struct *work) { pr_info("%s enter\n", __func__); aw87519_cfg_update(aw87519); } #endif static int aw87519_cfg_init(struct aw87519 *aw87519) { int ret = -1; #ifdef AWINIC_CFG_UPDATE_DELAY int cfg_timer_val = 5000; INIT_DELAYED_WORK(&aw87519->ram_work, aw87519_cfg_work_routine); schedule_delayed_work(&aw87519->ram_work, msecs_to_jiffies(cfg_timer_val)); ret = 0; #endif return ret; } /******************************************************************************* * aw87519 attribute ******************************************************************************/ static ssize_t aw87519_get_reg(struct device *dev, struct device_attribute *attr, char *buf) { ssize_t len = 0; unsigned int i = 0; unsigned char reg_val = 0; for (i = 0; i < AW87519_REG_MAX; i++) { aw87519_i2c_read(aw87519, i, ®_val); len += snprintf(buf + len, PAGE_SIZE - len, "reg:0x%02x=0x%02x\n", i, reg_val); } return len; } static ssize_t aw87519_set_reg(struct device *dev, struct device_attribute *attr, const char *buf, size_t len) { unsigned int databuf[2] = { 0, 0 }; if (sscanf(buf, "%x %x", &databuf[0], &databuf[1]) == 2) aw87519_i2c_write(aw87519, databuf[0], databuf[1]); return len; } static ssize_t aw87519_get_hwen(struct device *dev, struct device_attribute *attr, char *buf) { ssize_t len = 0; len += snprintf(buf + len, PAGE_SIZE - len, "hwen: %d\n", aw87519->hwen_flag); return len; } static ssize_t aw87519_set_hwen(struct device *dev, struct device_attribute *attr, const char *buf, size_t len) { int databuf; int ret = 0; ret = kstrtoint(buf, 10, &databuf); if (ret != 0) { pr_err("Incorrect argument\n"); return len; } if (databuf == 0) aw87519_hw_off(aw87519); else aw87519_hw_on(aw87519); return len; } static ssize_t aw87519_get_update(struct device *dev, struct device_attribute *attr, char *buf) { ssize_t len = 0; return len; } static ssize_t aw87519_set_update(struct device *dev, struct device_attribute *attr, const char *buf, size_t len) { int databuf; int ret; ret = kstrtoint(buf, 10, &databuf); if (ret != 0) { pr_err("Incorrect argument\n"); return len; } if (databuf == 0) { } else { aw87519->spk_cfg_update_flag = 1; aw87519->rcv_cfg_update_flag = 1; ret = request_firmware_nowait(THIS_MODULE, FW_ACTION_HOTPLUG, aw87519_spk_name, &aw87519->i2c_client->dev, GFP_KERNEL, aw87519, aw87519_speaker_cfg_loaded); if (ret) { pr_err("%s: request firmware failed with read %s", __func__, aw87519_spk_name); } } return len; } static ssize_t aw87519_get_mode(struct device *cd, struct device_attribute *attr, char *buf) { ssize_t len = 0; len += snprintf(buf + len, PAGE_SIZE - len, "0: off mode\n"); len += snprintf(buf + len, PAGE_SIZE - len, "1: spk mode\n"); len += snprintf(buf + len, PAGE_SIZE - len, "2: rcv mode\n"); return len; } static ssize_t aw87519_set_mode(struct device *dev, struct device_attribute *attr, const char *buf, size_t len) { int databuf; int ret = 0; ret = kstrtoint(buf, 10, &databuf); if (ret != 0) { pr_err("Incorrect argument\n"); return len; } if (databuf == 0) aw87519_amp_rch_off(); else if (databuf == 1) aw87519_amp_rch_on(); else if (databuf == 2) aw87519_right_audio_receiver(); else aw87519_amp_rch_off(); return len; } static DEVICE_ATTR(reg, AW87519_VAL, aw87519_get_reg, aw87519_set_reg); static DEVICE_ATTR(hwen, AW87519_VAL, aw87519_get_hwen, aw87519_set_hwen); static DEVICE_ATTR(update, AW87519_VAL, aw87519_get_update, aw87519_set_update); static DEVICE_ATTR(mode, AW87519_VAL, aw87519_get_mode, aw87519_set_mode); static struct attribute *aw87519_attributes[] = { &dev_attr_reg.attr, &dev_attr_hwen.attr, &dev_attr_update.attr, &dev_attr_mode.attr, NULL }; static struct attribute_group aw87519_attribute_group = { .attrs = aw87519_attributes }; /***************************************************** * device tree *****************************************************/ static int aw87519_parse_dt(struct device *dev, struct device_node *np) { pr_info("%s enter\n", __func__); aw87519->reset_gpio = of_get_named_gpio(np, "reset-gpio", 0); if (aw87519->reset_gpio >= 0) { dev_info(dev, "%s: reset gpio provided ok\n", __func__); } else { dev_err(dev, "%s: reset gpio provided failed.\n", __func__); return -1; } return 0; } static int aw87519_hw_reset(struct aw87519 *aw87519) { pr_info("%s enter\n", __func__); if (aw87519 && gpio_is_valid(aw87519->reset_gpio)) { gpio_set_value_cansleep(aw87519->reset_gpio, 0); usleep_range(2000, 2500); gpio_set_value_cansleep(aw87519->reset_gpio, 1); usleep_range(2000, 2500); aw87519->hwen_flag = 1; } else { aw87519->hwen_flag = 0; dev_err(&aw87519->i2c_client->dev, "%s: failed\n", __func__); } return 0; } /***************************************************** * check chip id *****************************************************/ static int aw87519_read_chipid(struct aw87519 *aw87519) { unsigned int cnt = 0; int ret = -1; unsigned char reg_val = 0; while (cnt < AW_READ_CHIPID_RETRIES) { aw87519_i2c_write(aw87519, 0x64, 0x2C); ret = aw87519_i2c_read(aw87519, REG_CHIPID, ®_val); if (reg_val != AW87519_CHIPID) pr_info("%s: aw87519 chipid=0x%x error\n", __func__, reg_val); else { pr_info("%s This Chip is AW87519 chipid=0x%x\n", __func__, reg_val); return 0; } cnt++; msleep(AW_READ_CHIPID_RETRY_DELAY); } return -EINVAL; } /******************************************************************************* * aw87519 i2c driver ******************************************************************************/ static int aw87519_i2c_probe(struct i2c_client *client, const struct i2c_device_id *id) { struct device_node *np = client->dev.of_node; int ret = -1; pr_info("%s right Enter\n", __func__); if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) { dev_err(&client->dev, "%s: check_functionality failed\n", __func__); ret = -ENODEV; goto exit_check_functionality_failed; } aw87519 = devm_kzalloc(&client->dev, sizeof(struct aw87519), GFP_KERNEL); if (aw87519 == NULL) { ret = -ENOMEM; goto exit_devm_kzalloc_failed; } aw87519->i2c_client = client; i2c_set_clientdata(client, aw87519); /* aw87519 rst */ if (np) { ret = aw87519_parse_dt(&client->dev, np); if (ret) { dev_err(&client->dev, "%s: failed to parse device tree node\n", __func__); goto exit_gpio_get_failed; } } else { aw87519->reset_gpio = -1; } if (gpio_is_valid(aw87519->reset_gpio)) { ret = devm_gpio_request_one(&client->dev, aw87519->reset_gpio, GPIOF_OUT_INIT_LOW, "aw87519_rst"); if (ret) { dev_err(&client->dev, "%s: rst request failed\n", __func__); goto exit_gpio_request_failed; } } /* hardware reset */ aw87519_hw_reset(aw87519); /* aw87519 chip id */ ret = aw87519_read_chipid(aw87519); if (ret < 0) { dev_err(&client->dev, "%s: aw87519_read_chipid failed ret=%d\n", __func__, ret); goto exit_i2c_check_id_failed; } ret = sysfs_create_group(&client->dev.kobj, &aw87519_attribute_group); if (ret < 0) dev_info(&client->dev, "%s error creating sysfs attr files\n", __func__); /* aw87519 cfg update */ aw87519->spk_cfg_update_flag = 0; aw87519->rcv_cfg_update_flag = 0; aw87519_cfg_init(aw87519); /* aw87519 hardware off */ aw87519_hw_off(aw87519); return 0; exit_i2c_check_id_failed: devm_gpio_free(&client->dev, aw87519->reset_gpio); exit_gpio_request_failed: exit_gpio_get_failed: devm_kfree(&client->dev, aw87519); aw87519 = NULL; exit_devm_kzalloc_failed: exit_check_functionality_failed: return ret; } static int aw87519_i2c_remove(struct i2c_client *client) { struct aw87519 *aw87519 = i2c_get_clientdata(client); if (gpio_is_valid(aw87519->reset_gpio)) devm_gpio_free(&client->dev, aw87519->reset_gpio); return 0; } static const struct i2c_device_id aw87519_i2c_id[] = { {AW87519_RIGHT_I2C_NAME, 0}, {} }; static const struct of_device_id extpa_of_match[] = { {.compatible = "awinic,aw87519_right"}, {}, }; static struct i2c_driver aw87519_i2c_driver = { .driver = { .owner = THIS_MODULE, .name = AW87519_RIGHT_I2C_NAME, .of_match_table = extpa_of_match, }, .probe = aw87519_i2c_probe, .remove = aw87519_i2c_remove, .id_table = aw87519_i2c_id, }; static int __init aw87519_pa_init(void) { int ret; pr_info("%s: right version: %s\n", __func__, AW87519_RIGHT_DRIVER_VERSION); ret = i2c_add_driver(&aw87519_i2c_driver); if (ret) { pr_info("[%s] Unable to register driver (%d)\n", __func__, ret); return ret; } return 0; } static void __exit aw87519_pa_exit(void) { pr_info("%s enter\n", __func__); i2c_del_driver(&aw87519_i2c_driver); } module_init(aw87519_pa_init); module_exit(aw87519_pa_exit); MODULE_AUTHOR(""); MODULE_DESCRIPTION("AWINIC AW87519 PA driver"); MODULE_LICENSE("GPL v2");