Subversion Repositories or1k_soc_on_altera_embedded_dev_kit

/* Bluetooth HCI driver model support. */

#include <linux/kernel.h>

#include <linux/init.h>

#include <linux/platform_device.h>

#include <net/bluetooth/bluetooth.h>

#include <net/bluetooth/hci_core.h>

#ifndef CONFIG_BT_HCI_CORE_DEBUG

#undef  BT_DBG

#define BT_DBG(D...)

#endif

static inline char *typetostr(int type)

{

        switch (type) {

        case HCI_VIRTUAL:

                return "VIRTUAL";

        case HCI_USB:

                return "USB";

        case HCI_PCCARD:

                return "PCCARD";

        case HCI_UART:

                return "UART";

        case HCI_RS232:

                return "RS232";

        case HCI_PCI:

                return "PCI";

        case HCI_SDIO:

                return "SDIO";

        default:

                return "UNKNOWN";

        }

}

static ssize_t show_type(struct device *dev, struct device_attribute *attr, char *buf)

{

        struct hci_dev *hdev = dev_get_drvdata(dev);

        return sprintf(buf, "%s\n", typetostr(hdev->type));

}

static ssize_t show_name(struct device *dev, struct device_attribute *attr, char *buf)

{

        struct hci_dev *hdev = dev_get_drvdata(dev);

        char name[249];

        int i;

        for (i = 0; i < 248; i++)

                name[i] = hdev->dev_name[i];

        name[248] = '\0';

        return sprintf(buf, "%s\n", name);

}

static ssize_t show_class(struct device *dev, struct device_attribute *attr, char *buf)

{

        struct hci_dev *hdev = dev_get_drvdata(dev);

        return sprintf(buf, "0x%.2x%.2x%.2x\n",

                        hdev->dev_class[2], hdev->dev_class[1], hdev->dev_class[0]);

}

static ssize_t show_address(struct device *dev, struct device_attribute *attr, char *buf)

{

        struct hci_dev *hdev = dev_get_drvdata(dev);

        bdaddr_t bdaddr;

        baswap(&bdaddr, &hdev->bdaddr);

        return sprintf(buf, "%s\n", batostr(&bdaddr));

}

static ssize_t show_features(struct device *dev, struct device_attribute *attr, char *buf)

{

        struct hci_dev *hdev = dev_get_drvdata(dev);

        return sprintf(buf, "0x%02x%02x%02x%02x%02x%02x%02x%02x\n",

                                hdev->features[0], hdev->features[1],

                                hdev->features[2], hdev->features[3],

                                hdev->features[4], hdev->features[5],

                                hdev->features[6], hdev->features[7]);

}

static ssize_t show_manufacturer(struct device *dev, struct device_attribute *attr, char *buf)

{

        struct hci_dev *hdev = dev_get_drvdata(dev);

        return sprintf(buf, "%d\n", hdev->manufacturer);

}

static ssize_t show_hci_version(struct device *dev, struct device_attribute *attr, char *buf)

{

        struct hci_dev *hdev = dev_get_drvdata(dev);

        return sprintf(buf, "%d\n", hdev->hci_ver);

}

static ssize_t show_hci_revision(struct device *dev, struct device_attribute *attr, char *buf)

{

        struct hci_dev *hdev = dev_get_drvdata(dev);

        return sprintf(buf, "%d\n", hdev->hci_rev);

}

static ssize_t show_inquiry_cache(struct device *dev, struct device_attribute *attr, char *buf)

{

        struct hci_dev *hdev = dev_get_drvdata(dev);

        struct inquiry_cache *cache = &hdev->inq_cache;

        struct inquiry_entry *e;

        int n = 0;

        hci_dev_lock_bh(hdev);

        for (e = cache->list; e; e = e->next) {

                struct inquiry_data *data = &e->data;

                bdaddr_t bdaddr;

                baswap(&bdaddr, &data->bdaddr);

                n += sprintf(buf + n, "%s %d %d %d 0x%.2x%.2x%.2x 0x%.4x %d %u\n",

                                batostr(&bdaddr),

                                data->pscan_rep_mode, data->pscan_period_mode, data->pscan_mode,

                                data->dev_class[2], data->dev_class[1], data->dev_class[0],

                                __le16_to_cpu(data->clock_offset), data->rssi, e->timestamp);

        }

        hci_dev_unlock_bh(hdev);

        return n;

}

static ssize_t show_idle_timeout(struct device *dev, struct device_attribute *attr, char *buf)

{

        struct hci_dev *hdev = dev_get_drvdata(dev);

        return sprintf(buf, "%d\n", hdev->idle_timeout);

}

static ssize_t store_idle_timeout(struct device *dev, struct device_attribute *attr, const char *buf, size_t count)

{

        struct hci_dev *hdev = dev_get_drvdata(dev);

        char *ptr;

        __u32 val;

        val = simple_strtoul(buf, &ptr, 10);

        if (ptr == buf)

                return -EINVAL;

        if (val != 0 && (val < 500 || val > 3600000))

                return -EINVAL;

        hdev->idle_timeout = val;

        return count;

}

static ssize_t show_sniff_max_interval(struct device *dev, struct device_attribute *attr, char *buf)

{

        struct hci_dev *hdev = dev_get_drvdata(dev);

        return sprintf(buf, "%d\n", hdev->sniff_max_interval);

}

static ssize_t store_sniff_max_interval(struct device *dev, struct device_attribute *attr, const char *buf, size_t count)

{

        struct hci_dev *hdev = dev_get_drvdata(dev);

        char *ptr;

        __u16 val;

        val = simple_strtoul(buf, &ptr, 10);

        if (ptr == buf)

                return -EINVAL;

        if (val < 0x0002 || val > 0xFFFE || val % 2)

                return -EINVAL;

        if (val < hdev->sniff_min_interval)

                return -EINVAL;

        hdev->sniff_max_interval = val;

        return count;

}

static ssize_t show_sniff_min_interval(struct device *dev, struct device_attribute *attr, char *buf)

{

        struct hci_dev *hdev = dev_get_drvdata(dev);

        return sprintf(buf, "%d\n", hdev->sniff_min_interval);

}

static ssize_t store_sniff_min_interval(struct device *dev, struct device_attribute *attr, const char *buf, size_t count)

{

        struct hci_dev *hdev = dev_get_drvdata(dev);

        char *ptr;

        __u16 val;

        val = simple_strtoul(buf, &ptr, 10);

        if (ptr == buf)

                return -EINVAL;

        if (val < 0x0002 || val > 0xFFFE || val % 2)

                return -EINVAL;

        if (val > hdev->sniff_max_interval)

                return -EINVAL;

        hdev->sniff_min_interval = val;

        return count;

}

static DEVICE_ATTR(type, S_IRUGO, show_type, NULL);

static DEVICE_ATTR(name, S_IRUGO, show_name, NULL);

static DEVICE_ATTR(class, S_IRUGO, show_class, NULL);

static DEVICE_ATTR(address, S_IRUGO, show_address, NULL);

static DEVICE_ATTR(features, S_IRUGO, show_features, NULL);

static DEVICE_ATTR(manufacturer, S_IRUGO, show_manufacturer, NULL);

static DEVICE_ATTR(hci_version, S_IRUGO, show_hci_version, NULL);

static DEVICE_ATTR(hci_revision, S_IRUGO, show_hci_revision, NULL);

static DEVICE_ATTR(inquiry_cache, S_IRUGO, show_inquiry_cache, NULL);

static DEVICE_ATTR(idle_timeout, S_IRUGO | S_IWUSR,

                                show_idle_timeout, store_idle_timeout);

static DEVICE_ATTR(sniff_max_interval, S_IRUGO | S_IWUSR,

                                show_sniff_max_interval, store_sniff_max_interval);

static DEVICE_ATTR(sniff_min_interval, S_IRUGO | S_IWUSR,

                                show_sniff_min_interval, store_sniff_min_interval);

static struct device_attribute *bt_attrs[] = {

        &dev_attr_type,

        &dev_attr_name,

        &dev_attr_class,

        &dev_attr_address,

        &dev_attr_features,

        &dev_attr_manufacturer,

        &dev_attr_hci_version,

        &dev_attr_hci_revision,

        &dev_attr_inquiry_cache,

        &dev_attr_idle_timeout,

        &dev_attr_sniff_max_interval,

        &dev_attr_sniff_min_interval,

        NULL

};

static ssize_t show_conn_type(struct device *dev, struct device_attribute *attr, char *buf)

{

        struct hci_conn *conn = dev_get_drvdata(dev);

        return sprintf(buf, "%s\n", conn->type == ACL_LINK ? "ACL" : "SCO");

}

static ssize_t show_conn_address(struct device *dev, struct device_attribute *attr, char *buf)

{

        struct hci_conn *conn = dev_get_drvdata(dev);

        bdaddr_t bdaddr;

        baswap(&bdaddr, &conn->dst);

        return sprintf(buf, "%s\n", batostr(&bdaddr));

}

#define CONN_ATTR(_name,_mode,_show,_store) \

struct device_attribute conn_attr_##_name = __ATTR(_name,_mode,_show,_store)

static CONN_ATTR(type, S_IRUGO, show_conn_type, NULL);

static CONN_ATTR(address, S_IRUGO, show_conn_address, NULL);

static struct device_attribute *conn_attrs[] = {

        &conn_attr_type,

        &conn_attr_address,

        NULL

};

struct class *bt_class = NULL;

EXPORT_SYMBOL_GPL(bt_class);

static struct bus_type bt_bus = {

        .name   = "bluetooth",

};

static struct platform_device *bt_platform;

static void bt_release(struct device *dev)

{

        void *data = dev_get_drvdata(dev);

        kfree(data);

}

static void add_conn(struct work_struct *work)

{

        struct hci_conn *conn = container_of(work, struct hci_conn, work);

        int i;

        if (device_add(&conn->dev) < 0) {

                BT_ERR("Failed to register connection device");

                return;

        }

        for (i = 0; conn_attrs[i]; i++)

                if (device_create_file(&conn->dev, conn_attrs[i]) < 0)

                        BT_ERR("Failed to create connection attribute");

}

void hci_conn_add_sysfs(struct hci_conn *conn)

{

        struct hci_dev *hdev = conn->hdev;

        bdaddr_t *ba = &conn->dst;

        BT_DBG("conn %p", conn);

        conn->dev.bus = &bt_bus;

        conn->dev.parent = &hdev->dev;

        conn->dev.release = bt_release;

        snprintf(conn->dev.bus_id, BUS_ID_SIZE,

                        "%s%2.2X%2.2X%2.2X%2.2X%2.2X%2.2X",

                        conn->type == ACL_LINK ? "acl" : "sco",

                        ba->b[5], ba->b[4], ba->b[3],

                        ba->b[2], ba->b[1], ba->b[0]);

        dev_set_drvdata(&conn->dev, conn);

        device_initialize(&conn->dev);

        INIT_WORK(&conn->work, add_conn);

        schedule_work(&conn->work);

}

static int __match_tty(struct device *dev, void *data)

{

        /* The rfcomm tty device will possibly retain even when conn

         * is down, and sysfs doesn't support move zombie device,

         * so we should move the device before conn device is destroyed.

         * Due to the only child device of hci_conn dev is rfcomm

         * tty_dev, here just return 1

         */

        return 1;

}

static void del_conn(struct work_struct *work)

{

        struct device *dev;

        struct hci_conn *conn = container_of(work, struct hci_conn, work);

        while (dev = device_find_child(&conn->dev, NULL, __match_tty)) {

                device_move(dev, NULL);

                put_device(dev);

        }

        device_del(&conn->dev);

        put_device(&conn->dev);

}

void hci_conn_del_sysfs(struct hci_conn *conn)

{

        BT_DBG("conn %p", conn);

        if (!device_is_registered(&conn->dev))

                return;

        INIT_WORK(&conn->work, del_conn);

        schedule_work(&conn->work);

}

int hci_register_sysfs(struct hci_dev *hdev)

{

        struct device *dev = &hdev->dev;

        unsigned int i;

        int err;

        BT_DBG("%p name %s type %d", hdev, hdev->name, hdev->type);

        dev->bus = &bt_bus;

        dev->parent = hdev->parent;

        strlcpy(dev->bus_id, hdev->name, BUS_ID_SIZE);

        dev->release = bt_release;

        dev_set_drvdata(dev, hdev);

        err = device_register(dev);

        if (err < 0)

                return err;

        for (i = 0; bt_attrs[i]; i++)

                if (device_create_file(dev, bt_attrs[i]) < 0)

                        BT_ERR("Failed to create device attribute");

        if (sysfs_create_link(&bt_class->subsys.kobj,

                                &dev->kobj, kobject_name(&dev->kobj)) < 0)

                BT_ERR("Failed to create class symlink");

        return 0;

}

void hci_unregister_sysfs(struct hci_dev *hdev)

{

        BT_DBG("%p name %s type %d", hdev, hdev->name, hdev->type);

        sysfs_remove_link(&bt_class->subsys.kobj,

                                        kobject_name(&hdev->dev.kobj));

        device_del(&hdev->dev);

}

int __init bt_sysfs_init(void)

{

        int err;

        bt_platform = platform_device_register_simple("bluetooth", -1, NULL, 0);

        if (IS_ERR(bt_platform))

                return PTR_ERR(bt_platform);

        err = bus_register(&bt_bus);

        if (err < 0) {

                platform_device_unregister(bt_platform);

                return err;

        }

        bt_class = class_create(THIS_MODULE, "bluetooth");

        if (IS_ERR(bt_class)) {

                bus_unregister(&bt_bus);

                platform_device_unregister(bt_platform);

                return PTR_ERR(bt_class);

        }

        return 0;

}

void bt_sysfs_cleanup(void)

{

        class_destroy(bt_class);

        bus_unregister(&bt_bus);

        platform_device_unregister(bt_platform);

}