static int bcm2079x_probe(struct i2c_client *client, const struct i2c_device_id *id) { int ret; struct bcm2079x_platform_data *platform_data; struct bcm2079x_dev *bcm2079x_dev; /*platform_data = client->dev.platform_data; dev_info(&client->dev, "%s, probing bcm2079x driver flags = %x\n", __func__, client->flags); if (platform_data == NULL) { dev_err(&client->dev, "nfc probe fail\n"); return -ENODEV; }*/ if (client ->dev.of_node) { platform_data = devm_kzalloc(&client ->dev,sizeof(struct bcm2079x_platform_data), GFP_KERNEL); if (!platform_data) { dev_err(&client ->dev, "Failed to allocate memory \n"); return -ENOMEM; } ret = bcm2079x_parse_dt(&client ->dev, platform_data); if (ret) return ret; } if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) { dev_err(&client->dev, "need I2C_FUNC_I2C\n"); return -ENODEV; } ret = gpio_request(platform_data->irq_gpio, "nfc_int"); if (ret) return -ENODEV; ret = gpio_request(platform_data->en_gpio, "nfc_ven"); if (ret) goto err_en; ret = gpio_request(platform_data->wake_gpio, "nfc_firm"); if (ret) goto err_firm; gpio_direction_output(platform_data->en_gpio, 0 ); gpio_direction_output(platform_data->wake_gpio, 0); gpio_set_value(platform_data->en_gpio, 0); gpio_set_value(platform_data->wake_gpio, 0); gpio_direction_input(platform_data->irq_gpio ); bcm2079x_dev = kzalloc(sizeof(*bcm2079x_dev), GFP_KERNEL); if (bcm2079x_dev == NULL) { dev_err(&client->dev, "failed to allocate memory for module data\n"); ret = -ENOMEM; goto err_exit; } bcm2079x_dev->wake_gpio = platform_data->wake_gpio; bcm2079x_dev->irq_gpio = platform_data->irq_gpio; bcm2079x_dev->en_gpio = platform_data->en_gpio; bcm2079x_dev->client = client; /* init mutex and queues */ init_waitqueue_head(&bcm2079x_dev->read_wq); mutex_init(&bcm2079x_dev->read_mutex); spin_lock_init(&bcm2079x_dev->irq_enabled_lock); bcm2079x_dev->bcm2079x_device.minor = MISC_DYNAMIC_MINOR; bcm2079x_dev->bcm2079x_device.name = "bcm2079x"; bcm2079x_dev->bcm2079x_device.fops = &bcm2079x_dev_fops; ret = misc_register(&bcm2079x_dev->bcm2079x_device); if (ret) { dev_err(&client->dev, "misc_register failed\n"); goto err_misc_register; } dev_info(&client->dev, "%s, saving address %d\n", __func__, client->addr); bcm2079x_dev->original_address = client->addr; //enable clk 19.2M printk("[dsc] enable clk 19.2M\n"); nfc_rf_clk = clk_get(&client->dev, "ref_clk"); if (nfc_rf_clk != NULL) { if (clk_prepare_enable(nfc_rf_clk)) pr_err("failed request NFC_CLK.\n"); } else { pr_err("%s:nfc_rf_clk is null\n",__FUNCTION__); } /* request irq. the irq is set whenever the chip has data available * for reading. it is cleared when all data has been read. */ dev_info(&client->dev, "requesting IRQ %d with IRQF_NO_SUSPEND\n", client->irq); bcm2079x_dev->irq_enabled = true; ret = request_irq(client->irq, bcm2079x_dev_irq_handler, IRQF_TRIGGER_RISING|IRQF_NO_SUSPEND, client->name, bcm2079x_dev); if (ret) { dev_err(&client->dev, "request_irq failed\n"); goto err_request_irq_failed; } enable_irq_wake(client->irq); bcm2079x_disable_irq(bcm2079x_dev); i2c_set_clientdata(client, bcm2079x_dev); dev_info(&client->dev, "%s, probing bcm2079x driver exited successfully\n", __func__); #ifdef USE_WAKE_LOCK wake_lock_init(&bcm2079x_dev->wake_lock , WAKE_LOCK_SUSPEND, "nfcwakelock" ); #endif return 0; err_request_irq_failed: misc_deregister(&bcm2079x_dev->bcm2079x_device); err_misc_register: mutex_destroy(&bcm2079x_dev->read_mutex); kfree(bcm2079x_dev); err_exit: gpio_free(platform_data->wake_gpio); err_firm: gpio_free(platform_data->en_gpio); err_en: gpio_free(platform_data->irq_gpio); return ret; }
static int bcm2079x_probe(struct i2c_client *client, const struct i2c_device_id *id) { int ret; int err; struct bcm2079x_platform_data *platform_data; struct bcm2079x_dev *bcm2079x_dev; #ifdef DEBUG_BCM2079X_I2C_IRQ char tmp[5] = {0x10, 0x20, 0x00, 0x01, 0x00}; #endif if (client->dev.of_node) { platform_data = devm_kzalloc(&client->dev, sizeof(struct bcm2079x_platform_data), GFP_KERNEL); if (!platform_data) { dev_err(&client->dev, "Failed to allocate memory\n"); return -ENOMEM; } err = bcm2079x_parse_dt(&client->dev, platform_data); if (err) return err; } else { platform_data = client->dev.platform_data; } dev_info(&client->dev, "%s, probing bcm2079x driver flags = %x\n", __func__, client->flags); if (platform_data == NULL) { dev_err(&client->dev, "nfc probe fail\n"); return -ENODEV; } if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) { dev_err(&client->dev, "need I2C_FUNC_I2C\n"); return -ENODEV; } ret = gpio_request(platform_data->irq_gpio, "nfc_int"); if (ret) return -ENODEV; gpio_direction_input(platform_data->irq_gpio); ret = gpio_request(platform_data->en_gpio, "nfc_en"); if (ret) goto err_en; gpio_direction_output(platform_data->en_gpio, 0); ret = gpio_request(platform_data->wake_gpio, "nfc_wake"); if (ret) goto err_firm; gpio_direction_output(platform_data->wake_gpio, 0); #ifdef DEBUG_BCM2079X_I2C_IRQ msleep(100); gpio_set_value_cansleep(platform_data->en_gpio, 1); msleep(100); #else gpio_set_value_cansleep(platform_data->en_gpio, 0); #endif gpio_set_value_cansleep(platform_data->wake_gpio, 1); bcm2079x_dev = kzalloc(sizeof(*bcm2079x_dev), GFP_KERNEL); if (bcm2079x_dev == NULL) { dev_err(&client->dev, "failed to allocate memory for module data\n"); ret = -ENOMEM; goto err_exit; } bcm2079x_dev->wake_gpio = platform_data->wake_gpio; bcm2079x_dev->irq_gpio = platform_data->irq_gpio; bcm2079x_dev->en_gpio = platform_data->en_gpio; bcm2079x_dev->client = client; /* init mutex and queues */ init_waitqueue_head(&bcm2079x_dev->read_wq); mutex_init(&bcm2079x_dev->read_mutex); spin_lock_init(&bcm2079x_dev->irq_enabled_lock); bcm2079x_dev->bcm2079x_device.minor = MISC_DYNAMIC_MINOR; bcm2079x_dev->bcm2079x_device.name = "bcm2079x"; bcm2079x_dev->bcm2079x_device.fops = &bcm2079x_dev_fops; ret = misc_register(&bcm2079x_dev->bcm2079x_device); if (ret) { dev_err(&client->dev, "misc_register failed\n"); goto err_misc_register; } /* wake lock init */ wake_lock_init(&bcm2079x_dev->nfc_wake_lock, WAKE_LOCK_SUSPEND, "nfc_wake_lock"); /* request irq. the irq is set whenever the chip has data available * for reading. it is cleared when all data has been read. */ pr_info("\n client irq is %d\n",client->irq); dev_info(&client->dev, "requesting IRQ %d with IRQF_NO_SUSPEND\n", client->irq); ret = request_irq(client->irq, bcm2079x_dev_irq_handler, IRQF_TRIGGER_RISING|IRQF_NO_SUSPEND, client->name, bcm2079x_dev); if (ret) { dev_err(&client->dev, "request_irq failed\n"); goto err_request_irq_failed; } i2c_set_clientdata(client, bcm2079x_dev); #ifndef DEBUG_BCM2079X_I2C_IRQ bcm2079x_dev->irq_enabled = false; disable_irq_nosync(bcm2079x_dev->client->irq); #else /* NCI reset test */ ret = i2c_master_send(bcm2079x_dev->client, tmp, sizeof(tmp)); if (ret != 5) pr_err("%s, i2c write error, NCI rest cmd err = %d\n", __func__, ret); else pr_info("%s, i2c write success!!! ret = %d\n", __func__, ret); #endif dev_info(&client->dev, "%s, probing bcm2079x driver exited successfully\n", __func__); return 0; err_request_irq_failed: wake_lock_destroy(&bcm2079x_dev->nfc_wake_lock); misc_deregister(&bcm2079x_dev->bcm2079x_device); err_misc_register: mutex_destroy(&bcm2079x_dev->read_mutex); kfree(bcm2079x_dev); err_exit: gpio_free(platform_data->wake_gpio); err_firm: gpio_free(platform_data->en_gpio); err_en: gpio_free(platform_data->irq_gpio); return ret; }