// 设置 BT_WAKE_HOST IRQ static int rfkill_rk_setup_wake_irq(struct rfkill_rk_data* rfkill) { int ret=0; struct rfkill_rk_irq* irq = &(rfkill->pdata->wake_host_irq); ret = rfkill_rk_setup_gpio(&irq->gpio, IOMUX_FGPIO, rfkill->pdata->name, "wake_host"); if (ret) goto fail1; if (gpio_is_valid(irq->gpio.io)) { ret = gpio_pull_updown(irq->gpio.io, (irq->gpio.enable==GPIO_LOW)?GPIOPullUp:GPIOPullDown); if (ret) goto fail2; LOG("Request irq for bt wakeup host\n"); irq->irq = gpio_to_irq(irq->gpio.io); sprintf(irq->name, "%s_irq", irq->gpio.name); ret = request_irq(irq->irq, rfkill_rk_wake_host_irq, (irq->gpio.enable==GPIO_LOW)?IRQF_TRIGGER_FALLING:IRQF_TRIGGER_RISING, irq->name, rfkill); if (ret) goto fail2; LOG("** disable irq\n"); disable_irq(irq->irq); ret = enable_irq_wake(irq->irq); if (ret) goto fail3; } return ret; fail3: free_irq(irq->gpio.io, rfkill); fail2: gpio_free(irq->gpio.io); fail1: return ret; }
static int rfkill_rk_probe(struct platform_device *pdev) { struct rfkill_rk_data *rfkill; struct rfkill_rk_platform_data *pdata = pdev->dev.platform_data; int ret = 0; struct proc_dir_entry *ent; DBG("Enter %s\n", __func__); if (!pdata) { LOG("%s: No platform data specified\n", __func__); return -EINVAL; } pdata->name = (char*)bt_name; rfkill = kzalloc(sizeof(*rfkill), GFP_KERNEL); if (!rfkill) return -ENOMEM; rfkill->pdata = pdata; g_rfkill = rfkill; bluetooth_dir = proc_mkdir("bluetooth", NULL); if (bluetooth_dir == NULL) { LOG("Unable to create /proc/bluetooth directory"); return -ENOMEM; } sleep_dir = proc_mkdir("sleep", bluetooth_dir); if (sleep_dir == NULL) { LOG("Unable to create /proc/%s directory", PROC_DIR); return -ENOMEM; } /* read/write proc entries */ ent = create_proc_entry("lpm", 0, sleep_dir); if (ent == NULL) { LOG("Unable to create /proc/%s/lpm entry", PROC_DIR); ret = -ENOMEM; goto fail_alloc; } ent->read_proc = bluesleep_read_proc_lpm; ent->write_proc = bluesleep_write_proc_lpm; /* read/write proc entries */ ent = create_proc_entry("btwrite", 0, sleep_dir); if (ent == NULL) { LOG("Unable to create /proc/%s/btwrite entry", PROC_DIR); ret = -ENOMEM; goto fail_alloc; } ent->read_proc = bluesleep_read_proc_btwrite; ent->write_proc = bluesleep_write_proc_btwrite; // 申请GPIO以及IRQ DBG("init gpio\n"); // 对于RK29 BCM4329,它的poweron io与wifi共用,在boad文件中已经request // 此处不用去申请 #if !WIFI_BT_POWER_TOGGLE ret = rfkill_rk_setup_gpio(&pdata->poweron_gpio, IOMUX_FGPIO, pdata->name, "poweron"); if (ret) goto fail_alloc; #endif ret = rfkill_rk_setup_gpio(&pdata->reset_gpio, IOMUX_FGPIO, pdata->name, "reset"); if (ret) goto fail_poweron; ret = rfkill_rk_setup_gpio(&pdata->wake_gpio, IOMUX_FGPIO, pdata->name, "wake"); if (ret) goto fail_reset; ret = rfkill_rk_setup_wake_irq(rfkill); if (ret) goto fail_wake; ret = rfkill_rk_setup_gpio(&pdata->rts_gpio, IOMUX_FMUX, rfkill->pdata->name, "rts"); if (ret) goto fail_wake_host_irq; // 创建并注册RFKILL设备 DBG("setup rfkill\n"); rfkill->rfkill_dev = rfkill_alloc(pdata->name, &pdev->dev, pdata->type, &rfkill_rk_ops, rfkill); if (!rfkill->rfkill_dev) goto fail_rts; // cmy: 设置rfkill初始状态为blocked,在注册时不会调用 set_blocked函数 rfkill_set_states(rfkill->rfkill_dev, BT_BLOCKED, false); ret = rfkill_register(rfkill->rfkill_dev); if (ret < 0) goto fail_rfkill; wake_lock_init(&(rfkill->bt_irq_wl), WAKE_LOCK_SUSPEND, "rfkill_rk_irq_wl"); INIT_DELAYED_WORK(&rfkill->bt_sleep_delay_work, rfkill_rk_delay_sleep_bt); // cmy: 设置蓝牙电源的状态为 blocked rfkill_rk_set_power(rfkill, BT_BLOCKED); platform_set_drvdata(pdev, rfkill); LOG("%s device registered.\n", pdata->name); return 0; fail_rfkill: rfkill_destroy(rfkill->rfkill_dev); fail_rts: if (gpio_is_valid(pdata->rts_gpio.io)) gpio_free(pdata->rts_gpio.io); fail_wake_host_irq: if (gpio_is_valid(pdata->wake_host_irq.gpio.io)){ free_irq(pdata->wake_host_irq.irq, rfkill); gpio_free(pdata->wake_host_irq.gpio.io); } fail_wake: if (gpio_is_valid(pdata->wake_gpio.io)) gpio_free(pdata->wake_gpio.io); fail_reset: if (gpio_is_valid(pdata->reset_gpio.io)) gpio_free(pdata->reset_gpio.io); fail_poweron: #if !WIFI_BT_POWER_TOGGLE if (gpio_is_valid(pdata->poweron_gpio.io)) gpio_free(pdata->poweron_gpio.io); #endif fail_alloc: kfree(rfkill); g_rfkill = NULL; remove_proc_entry("btwrite", sleep_dir); remove_proc_entry("lpm", sleep_dir); return ret; }
static int rfkill_rk_probe(struct platform_device *pdev) { struct rfkill_rk_data *rfkill; struct rfkill_rk_platform_data *pdata = pdev->dev.platform_data; int ret = 0; DBG("Enter %s\n", __func__); if (!pdata) { LOG("%s: No platform data specified\n", __func__); return -EINVAL; } pdata->name = (char*)bt_name; rfkill = kzalloc(sizeof(*rfkill), GFP_KERNEL); if (!rfkill) return -ENOMEM; rfkill->pdata = pdata; g_rfkill = rfkill; // 申请GPIO以及IRQ DBG("init gpio\n"); // 对于RK29 BCM4329,它的poweron io与wifi共用,在boad文件中已经request // 此处不用去申请 #if !WIFI_BT_POWER_TOGGLE ret = rfkill_rk_setup_gpio(&pdata->poweron_gpio, IOMUX_FGPIO, pdata->name, "poweron"); if (ret) goto fail_alloc; #endif ret = rfkill_rk_setup_gpio(&pdata->reset_gpio, IOMUX_FGPIO, pdata->name, "reset"); if (ret) goto fail_poweron; ret = rfkill_rk_setup_gpio(&pdata->wake_gpio, IOMUX_FGPIO, pdata->name, "wake"); if (ret) goto fail_reset; ret = rfkill_rk_setup_wake_irq(rfkill); if (ret) goto fail_wake; ret = rfkill_rk_setup_gpio(&(pdata->rts_gpio), IOMUX_FNORMAL, rfkill->pdata->name, "rts"); if (ret) goto fail_wake_host_irq; // 创建并注册RFKILL设备 DBG("setup rfkill\n"); rfkill->rfkill_dev = rfkill_alloc(pdata->name, &pdev->dev, pdata->type, &rfkill_rk_ops, rfkill); if (!rfkill->rfkill_dev) goto fail_rts; // cmy: 设置rfkill初始状态为blocked,在注册时不会调用 set_blocked函数 rfkill_set_states(rfkill->rfkill_dev, BT_BLOCKED, false); ret = rfkill_register(rfkill->rfkill_dev); if (ret < 0) goto fail_rfkill; wake_lock_init(&(rfkill->bt_irq_wl), WAKE_LOCK_SUSPEND, "rfkill_rk_irq_wl"); INIT_DELAYED_WORK(&rfkill->bt_sleep_delay_work, rfkill_rk_delay_sleep_bt); // cmy: 设置蓝牙电源的状态为 blocked rfkill_rk_set_power(rfkill, BT_BLOCKED); platform_set_drvdata(pdev, rfkill); LOG("%s device registered.\n", pdata->name); return 0; fail_rfkill: rfkill_destroy(rfkill->rfkill_dev); fail_rts: if (gpio_is_valid(pdata->rts_gpio.io)) gpio_free(pdata->rts_gpio.io); fail_wake_host_irq: if (gpio_is_valid(pdata->wake_host_irq.gpio.io)){ free_irq(pdata->wake_host_irq.irq, rfkill); gpio_free(pdata->wake_host_irq.gpio.io); } fail_wake: if (gpio_is_valid(pdata->wake_gpio.io)) gpio_free(pdata->wake_gpio.io); fail_reset: if (gpio_is_valid(pdata->reset_gpio.io)) gpio_free(pdata->reset_gpio.io); fail_poweron: #if !WIFI_BT_POWER_TOGGLE if (gpio_is_valid(pdata->poweron_gpio.io)) gpio_free(pdata->poweron_gpio.io); #endif fail_alloc: kfree(rfkill); g_rfkill = NULL; return ret; }