/* * Copyright (C) 2009 Google, Inc. * Copyright (C) 2009 HTC Corporation. * * This software is licensed under the terms of the GNU General Public * License version 2, as published by the Free Software Foundation, and * may be copied, distributed, and modified under those terms. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * */ #include #include #include #include #include #include #include #include "board-mahimahi.h" static struct rfkill *bt_rfk; static const char bt_name[] = "bcm4329"; static int bluetooth_set_power(void *data, bool blocked) { if (!blocked) { gpio_direction_output(MAHIMAHI_GPIO_BT_RESET_N, 1); gpio_direction_output(MAHIMAHI_GPIO_BT_SHUTDOWN_N, 1); } else { gpio_direction_output(MAHIMAHI_GPIO_BT_SHUTDOWN_N, 0); gpio_direction_output(MAHIMAHI_GPIO_BT_RESET_N, 0); } return 0; } static struct rfkill_ops mahimahi_rfkill_ops = { .set_block = bluetooth_set_power, }; static int mahimahi_rfkill_probe(struct platform_device *pdev) { int rc = 0; bool default_state = true; /* off */ rc = gpio_request(MAHIMAHI_GPIO_BT_RESET_N, "bt_reset"); if (rc) goto err_gpio_reset; rc = gpio_request(MAHIMAHI_GPIO_BT_SHUTDOWN_N, "bt_shutdown"); if (rc) goto err_gpio_shutdown; bluetooth_set_power(NULL, default_state); bt_rfk = rfkill_alloc(bt_name, &pdev->dev, RFKILL_TYPE_BLUETOOTH, &mahimahi_rfkill_ops, NULL); if (!bt_rfk) { rc = -ENOMEM; goto err_rfkill_alloc; } rfkill_set_states(bt_rfk, default_state, false); /* userspace cannot take exclusive control */ rc = rfkill_register(bt_rfk); if (rc) goto err_rfkill_reg; return 0; err_rfkill_reg: rfkill_destroy(bt_rfk); err_rfkill_alloc: gpio_free(MAHIMAHI_GPIO_BT_SHUTDOWN_N); err_gpio_shutdown: gpio_free(MAHIMAHI_GPIO_BT_RESET_N); err_gpio_reset: return rc; } static int mahimahi_rfkill_remove(struct platform_device *dev) { rfkill_unregister(bt_rfk); rfkill_destroy(bt_rfk); gpio_free(MAHIMAHI_GPIO_BT_SHUTDOWN_N); gpio_free(MAHIMAHI_GPIO_BT_RESET_N); return 0; } static struct platform_driver mahimahi_rfkill_driver = { .probe = mahimahi_rfkill_probe, .remove = mahimahi_rfkill_remove, .driver = { .name = "mahimahi_rfkill", .owner = THIS_MODULE, }, }; static int __init mahimahi_rfkill_init(void) { if (!machine_is_mahimahi()) return 0; return platform_driver_register(&mahimahi_rfkill_driver); } static void __exit mahimahi_rfkill_exit(void) { platform_driver_unregister(&mahimahi_rfkill_driver); } module_init(mahimahi_rfkill_init); module_exit(mahimahi_rfkill_exit); MODULE_DESCRIPTION("mahimahi rfkill"); MODULE_AUTHOR("Nick Pelly "); MODULE_LICENSE("GPL");