mirror of
git://projects.qi-hardware.com/openwrt-xburst.git
synced 2024-09-12 17:02:05 +03:00
I fail really to see why this would be necessary here. So get rid of it and see if anything breaks... git-svn-id: svn://svn.openwrt.org/openwrt/trunk@17052 3c298f89-4303-0410-b956-a3cf2f4a3e73
253 lines
5.9 KiB
C
253 lines
5.9 KiB
C
/*
|
|
* Bluetooth PM code for the Openmoko Freerunner GSM Phone
|
|
*
|
|
* (C) 2007 by Openmoko Inc.
|
|
* Author: Harald Welte <laforge@openmoko.org>
|
|
* All rights reserved.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 as
|
|
* published by the Free Software Foundation
|
|
*
|
|
*/
|
|
|
|
#include <linux/module.h>
|
|
#include <linux/init.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/rfkill.h>
|
|
#include <linux/err.h>
|
|
|
|
#include <mach/hardware.h>
|
|
#include <asm/mach-types.h>
|
|
|
|
#include <mach/gta02.h>
|
|
#include <linux/mfd/pcf50633/gpio.h>
|
|
|
|
#include <linux/regulator/consumer.h>
|
|
|
|
#define DRVMSG "Openmoko Freerunner Bluetooth Power Management"
|
|
|
|
struct gta02_pm_bt_data {
|
|
struct regulator *regulator;
|
|
struct rfkill *rfkill;
|
|
int pre_resume_state;
|
|
};
|
|
|
|
static ssize_t bt_read(struct device *dev, struct device_attribute *attr,
|
|
char *buf)
|
|
{
|
|
int ret = 0;
|
|
if (!strcmp(attr->attr.name, "power_on")) {
|
|
if (s3c2410_gpio_getpin(GTA02_GPIO_BT_EN))
|
|
ret = 1;
|
|
} else if (!strcmp(attr->attr.name, "reset")) {
|
|
if (s3c2410_gpio_getpin(GTA02_GPIO_BT_EN) == 0)
|
|
ret = 1;
|
|
}
|
|
|
|
if (!ret) {
|
|
return strlcpy(buf, "0\n", 3);
|
|
} else {
|
|
return strlcpy(buf, "1\n", 3);
|
|
}
|
|
}
|
|
|
|
static void __gta02_pm_bt_toggle_radio(struct device *dev, unsigned int on)
|
|
{
|
|
struct gta02_pm_bt_data *bt_data = dev_get_drvdata(dev);
|
|
|
|
dev_info(dev, "__gta02_pm_bt_toggle_radio %d\n", on);
|
|
|
|
bt_data = dev_get_drvdata(dev);
|
|
|
|
s3c2410_gpio_setpin(GTA02_GPIO_BT_EN, !on);
|
|
|
|
if (on) {
|
|
if (!regulator_is_enabled(bt_data->regulator))
|
|
regulator_enable(bt_data->regulator);
|
|
} else {
|
|
if (regulator_is_enabled(bt_data->regulator))
|
|
regulator_disable(bt_data->regulator);
|
|
}
|
|
|
|
s3c2410_gpio_setpin(GTA02_GPIO_BT_EN, on);
|
|
}
|
|
|
|
|
|
static int bt_rfkill_toggle_radio(void *data, enum rfkill_state state)
|
|
{
|
|
struct device *dev = data;
|
|
unsigned long on = (state == RFKILL_STATE_ON);
|
|
|
|
__gta02_pm_bt_toggle_radio(dev, on);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static ssize_t bt_write(struct device *dev, struct device_attribute *attr,
|
|
const char *buf, size_t count)
|
|
{
|
|
unsigned long on = simple_strtoul(buf, NULL, 10);
|
|
struct gta02_pm_bt_data *bt_data = dev_get_drvdata(dev);
|
|
|
|
if (!strcmp(attr->attr.name, "power_on")) {
|
|
enum rfkill_state state = on ? RFKILL_STATE_ON : RFKILL_STATE_OFF;
|
|
bt_rfkill_toggle_radio(dev, state);
|
|
bt_data->rfkill->state = state;
|
|
|
|
__gta02_pm_bt_toggle_radio(dev, on);
|
|
} else if (!strcmp(attr->attr.name, "reset")) {
|
|
/* reset is low-active, so we need to invert */
|
|
s3c2410_gpio_setpin(GTA02_GPIO_BT_EN, on ? 0 : 1);
|
|
}
|
|
|
|
return count;
|
|
}
|
|
|
|
static DEVICE_ATTR(power_on, 0644, bt_read, bt_write);
|
|
static DEVICE_ATTR(reset, 0644, bt_read, bt_write);
|
|
|
|
#ifdef CONFIG_PM
|
|
static int gta02_bt_suspend(struct platform_device *pdev, pm_message_t state)
|
|
{
|
|
struct gta02_pm_bt_data *bt_data = dev_get_drvdata(&pdev->dev);
|
|
|
|
dev_dbg(&pdev->dev, DRVMSG ": suspending\n");
|
|
|
|
bt_data->pre_resume_state = s3c2410_gpio_getpin(GTA02_GPIO_BT_EN);
|
|
__gta02_pm_bt_toggle_radio(&pdev->dev, 0);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int gta02_bt_resume(struct platform_device *pdev)
|
|
{
|
|
struct gta02_pm_bt_data *bt_data = dev_get_drvdata(&pdev->dev);
|
|
dev_dbg(&pdev->dev, DRVMSG ": resuming\n");
|
|
|
|
__gta02_pm_bt_toggle_radio(&pdev->dev, bt_data->pre_resume_state);
|
|
return 0;
|
|
}
|
|
#else
|
|
#define gta02_bt_suspend NULL
|
|
#define gta02_bt_resume NULL
|
|
#endif
|
|
|
|
static struct attribute *gta02_bt_sysfs_entries[] = {
|
|
&dev_attr_power_on.attr,
|
|
&dev_attr_reset.attr,
|
|
NULL
|
|
};
|
|
|
|
static struct attribute_group gta02_bt_attr_group = {
|
|
.name = NULL,
|
|
.attrs = gta02_bt_sysfs_entries,
|
|
};
|
|
|
|
static int __init gta02_bt_probe(struct platform_device *pdev)
|
|
{
|
|
struct rfkill *rfkill;
|
|
struct regulator *regulator;
|
|
struct gta02_pm_bt_data *bt_data;
|
|
int ret;
|
|
|
|
dev_info(&pdev->dev, DRVMSG ": starting\n");
|
|
|
|
bt_data = kzalloc(sizeof(*bt_data), GFP_KERNEL);
|
|
dev_set_drvdata(&pdev->dev, bt_data);
|
|
|
|
regulator = regulator_get(&pdev->dev, "BT_3V2");
|
|
if (IS_ERR(regulator))
|
|
return -ENODEV;
|
|
|
|
bt_data->regulator = regulator;
|
|
|
|
/* this tests the true physical state of the regulator... */
|
|
if (regulator_is_enabled(regulator)) {
|
|
/*
|
|
* but these only operate on the logical state of the
|
|
* regulator... so we need to logicaly "adopt" it on
|
|
* to turn it off
|
|
*/
|
|
regulator_enable(regulator);
|
|
regulator_disable(regulator);
|
|
}
|
|
|
|
/* we pull reset to low to make sure that the chip doesn't
|
|
* drain power through the reset line */
|
|
s3c2410_gpio_setpin(GTA02_GPIO_BT_EN, 0);
|
|
|
|
rfkill = rfkill_allocate(&pdev->dev, RFKILL_TYPE_BLUETOOTH);
|
|
|
|
rfkill->name = pdev->name;
|
|
rfkill->data = &pdev->dev;
|
|
rfkill->state = RFKILL_STATE_OFF;
|
|
rfkill->toggle_radio = bt_rfkill_toggle_radio;
|
|
|
|
ret = rfkill_register(rfkill);
|
|
if (ret) {
|
|
dev_err(&pdev->dev, "Failed to register rfkill\n");
|
|
return ret;
|
|
}
|
|
|
|
bt_data->rfkill = rfkill;
|
|
|
|
return sysfs_create_group(&pdev->dev.kobj, >a02_bt_attr_group);
|
|
}
|
|
|
|
static int gta02_bt_remove(struct platform_device *pdev)
|
|
{
|
|
struct gta02_pm_bt_data *bt_data = dev_get_drvdata(&pdev->dev);
|
|
struct regulator *regulator;
|
|
|
|
sysfs_remove_group(&pdev->dev.kobj, >a02_bt_attr_group);
|
|
|
|
if (bt_data->rfkill) {
|
|
rfkill_unregister(bt_data->rfkill);
|
|
rfkill_free(bt_data->rfkill);
|
|
}
|
|
|
|
if (!bt_data || !bt_data->regulator)
|
|
return 0;
|
|
|
|
regulator = bt_data->regulator;
|
|
|
|
/* Make sure regulator is disabled before calling regulator_put */
|
|
if (regulator_is_enabled(regulator))
|
|
regulator_disable(regulator);
|
|
|
|
regulator_put(regulator);
|
|
|
|
kfree(bt_data);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct platform_driver gta02_bt_driver = {
|
|
.probe = gta02_bt_probe,
|
|
.remove = gta02_bt_remove,
|
|
.suspend = gta02_bt_suspend,
|
|
.resume = gta02_bt_resume,
|
|
.driver = {
|
|
.name = "gta02-pm-bt",
|
|
},
|
|
};
|
|
|
|
static int __devinit gta02_bt_init(void)
|
|
{
|
|
return platform_driver_register(>a02_bt_driver);
|
|
}
|
|
|
|
static void gta02_bt_exit(void)
|
|
{
|
|
platform_driver_unregister(>a02_bt_driver);
|
|
}
|
|
|
|
module_init(gta02_bt_init);
|
|
module_exit(gta02_bt_exit);
|
|
|
|
MODULE_LICENSE("GPL");
|
|
MODULE_AUTHOR("Harald Welte <laforge@openmoko.org>");
|
|
MODULE_DESCRIPTION(DRVMSG);
|