path: root/arch/arm/plat-s3c24xx/neo1973_pm_bt.c

/*
 * Bluetooth PM code for the FIC Neo1973 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 <asm/plat-s3c24xx/neo1973.h>

/* For GTA01 */
#include <mach/gta01.h>
#include <linux/pcf50606.h>

/* For GTA02 */
#include <mach/gta02.h>
#include <linux/mfd/pcf50633/gpio.h>

#include <linux/regulator/consumer.h>

#define DRVMSG "FIC Neo1973 Bluetooth Power Management"

struct gta01_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;	
	struct gta01_pm_bt_data *bt_data = dev_get_drvdata(dev);

	if (!strcmp(attr->attr.name, "power_on")) {
		if (machine_is_neo1973_gta01()) {
			ret = regulator_is_enabled(bt_data->regulator);
		} else if (machine_is_neo1973_gta02()) {
			if (s3c2410_gpio_getpin(GTA02_GPIO_BT_EN))
				ret = 1;
		}
	} else if (!strcmp(attr->attr.name, "reset")) {
		if (machine_is_neo1973_gta01()) {
			if (s3c2410_gpio_getpin(GTA01_GPIO_BT_EN) == 0)
				ret = 1;
		} else if (machine_is_neo1973_gta02()) {
			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 gta01_pm_bt_data *bt_data = dev_get_drvdata(dev);

	dev_info(dev, "__gta02_pm_bt_toggle_radio %d\n", on);

	if (machine_is_neo1973_gta02()) {

		bt_data = dev_get_drvdata(dev);

		neo1973_gpb_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);
		}

		neo1973_gpb_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);
	struct gta01_pm_bt_data *bt_data = dev_get_drvdata(dev);

	if (machine_is_neo1973_gta01()) {
		/* if we are powering up, assert reset, then power,
		 * then release reset */
		if (on) {
			neo1973_gpb_setpin(GTA01_GPIO_BT_EN, 0);
				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);
		}
		neo1973_gpb_setpin(GTA01_GPIO_BT_EN, on);
	} else if (machine_is_neo1973_gta02())
		__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 gta01_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;

		if (machine_is_neo1973_gta01()) {
			/* if we are powering up, assert reset, then power,
			 * then release reset */
			if (on) {
				neo1973_gpb_setpin(GTA01_GPIO_BT_EN, 0);
				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);
			}

			neo1973_gpb_setpin(GTA01_GPIO_BT_EN, on);
		} else if (machine_is_neo1973_gta02())
			__gta02_pm_bt_toggle_radio(dev, on);

	} else if (!strcmp(attr->attr.name, "reset")) {
		/* reset is low-active, so we need to invert */
		if (machine_is_neo1973_gta01()) {
			neo1973_gpb_setpin(GTA01_GPIO_BT_EN, on ? 0 : 1);
		} else if (machine_is_neo1973_gta02()) {
			neo1973_gpb_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 gta01_bt_suspend(struct platform_device *pdev, pm_message_t state)
{
	struct gta01_pm_bt_data *bt_data = dev_get_drvdata(&pdev->dev);

	dev_dbg(&pdev->dev, DRVMSG ": suspending\n");

	if (machine_is_neo1973_gta01()) {
		if (regulator_is_enabled(bt_data->regulator))
			regulator_disable(bt_data->regulator);
	} else if (machine_is_neo1973_gta02()) {
		bt_data->pre_resume_state =
					  s3c2410_gpio_getpin(GTA02_GPIO_BT_EN);
		__gta02_pm_bt_toggle_radio(&pdev->dev, 0);
	}

	return 0;
}

static int gta01_bt_resume(struct platform_device *pdev)
{
	struct gta01_pm_bt_data *bt_data = dev_get_drvdata(&pdev->dev);
	dev_dbg(&pdev->dev, DRVMSG ": resuming\n");

	if (machine_is_neo1973_gta02()) {
		__gta02_pm_bt_toggle_radio(&pdev->dev,
						     bt_data->pre_resume_state);
	}

	return 0;
}
#else
#define gta01_bt_suspend	NULL
#define gta01_bt_resume		NULL
#endif

static struct attribute *gta01_bt_sysfs_entries[] = {
	&dev_attr_power_on.attr,
	&dev_attr_reset.attr,
	NULL
};

static struct attribute_group gta01_bt_attr_group = {
	.name	= NULL,
	.attrs	= gta01_bt_sysfs_entries,
};

static int __init gta01_bt_probe(struct platform_device *pdev)
{
	struct rfkill *rfkill;
	struct regulator *regulator;
	struct gta01_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);

	if (machine_is_neo1973_gta01()) {
		/* we make sure that the voltage is off */
		regulator = regulator_get(&pdev->dev, "BT_3V1");
		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 */
		neo1973_gpb_setpin(GTA01_GPIO_BT_EN, 0);
	} else if (machine_is_neo1973_gta02()) {
		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 */
		neo1973_gpb_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, &gta01_bt_attr_group);
}

static int gta01_bt_remove(struct platform_device *pdev)
{
	struct gta01_pm_bt_data *bt_data = dev_get_drvdata(&pdev->dev);
	struct regulator *regulator;

	sysfs_remove_group(&pdev->dev.kobj, &gta01_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 gta01_bt_driver = {
	.probe		= gta01_bt_probe,
	.remove		= gta01_bt_remove,
	.suspend	= gta01_bt_suspend,
	.resume		= gta01_bt_resume,
	.driver		= {
		.name		= "neo1973-pm-bt",
	},
};

static int __devinit gta01_bt_init(void)
{
	return platform_driver_register(&gta01_bt_driver);
}

static void gta01_bt_exit(void)
{
	platform_driver_unregister(&gta01_bt_driver);
}

module_init(gta01_bt_init);
module_exit(gta01_bt_exit);

MODULE_LICENSE("GPL");
MODULE_AUTHOR("Harald Welte <laforge@openmoko.org>");
MODULE_DESCRIPTION(DRVMSG);