Hi Antonio, On 15:09 Wed 08 Jun, Antonio Ospite wrote: > Add a plugin which handles the connection of a Sixaxis device, when a > new hidraw device is connected the plugin: > - Filters udev events, and select the Sixaxis device > - Sets LEDs to match the joystick system number (for USB and BT) > - Sets the Master bluetooth address in the Sixaxis (USB pairing) > - Adds the device to the database of the current default > adapter (BT association) Just a few (mostly cosmetic) comments. > > Signed-off-by: Bastien Nocera <hadess@xxxxxxxxxx> > Signed-off-by: Antonio Ospite <ospite@xxxxxxxxxxxxxxxxx> > --- > Makefile.am | 9 +- > acinclude.m4 | 10 + > plugins/sixaxis.c | 528 +++++++++++++++++++++++++++++++++++++++++++++++++++++ > 3 files changed, 545 insertions(+), 2 deletions(-) > create mode 100644 plugins/sixaxis.c > > diff --git a/Makefile.am b/Makefile.am > index 4659c80..0d567a9 100644 > --- a/Makefile.am > +++ b/Makefile.am > @@ -202,6 +202,11 @@ builtin_sources += health/hdp_main.c health/hdp_types.h \ > health/hdp_util.h health/hdp_util.c > endif > > +if SIXAXISPLUGIN > +builtin_modules += sixaxis > +builtin_sources += plugins/sixaxis.c > +endif > + > builtin_modules += hciops mgmtops > builtin_sources += plugins/hciops.c plugins/mgmtops.c > > @@ -253,7 +258,7 @@ src_bluetoothd_SOURCES = $(gdbus_sources) $(builtin_sources) \ > src/event.h src/event.c \ > src/oob.h src/oob.c src/eir.h src/eir.c > src_bluetoothd_LDADD = lib/libbluetooth.la @GLIB_LIBS@ @DBUS_LIBS@ \ > - @CAPNG_LIBS@ -ldl -lrt > + @CAPNG_LIBS@ @UDEV_LIBS@ -ldl -lrt > src_bluetoothd_LDFLAGS = -Wl,--export-dynamic \ > -Wl,--version-script=$(srcdir)/src/bluetooth.ver > > @@ -370,7 +375,7 @@ EXTRA_DIST += doc/manager-api.txt \ > > AM_YFLAGS = -d > > -AM_CFLAGS = @DBUS_CFLAGS@ @GLIB_CFLAGS@ @CAPNG_CFLAGS@ \ > +AM_CFLAGS = @DBUS_CFLAGS@ @GLIB_CFLAGS@ @CAPNG_CFLAGS@ @UDEV_CFLAGS@ \ > -DBLUETOOTH_PLUGIN_BUILTIN -DPLUGINDIR=\""$(plugindir)"\" > > INCLUDES = -I$(builddir)/lib -I$(builddir)/src -I$(srcdir)/src \ > diff --git a/acinclude.m4 b/acinclude.m4 > index d77937b..d8e4ba9 100644 > --- a/acinclude.m4 > +++ b/acinclude.m4 > @@ -183,6 +183,7 @@ AC_DEFUN([AC_ARG_BLUEZ], [ > sndfile_enable=${sndfile_found} > hal_enable=no > usb_enable=${usb_found} > + sixaxis_enable=${udev_found} > alsa_enable=${alsa_found} > gstreamer_enable=${gstreamer_found} > audio_enable=yes > @@ -277,6 +278,10 @@ AC_DEFUN([AC_ARG_BLUEZ], [ > usb_enable=${enableval} > ]) > > + AC_ARG_ENABLE(sixaxis, AC_HELP_STRING([--enable-sixaxis], [enable Sixaxis plugin]), [ > + sixaxis_enable=${enableval} > + ]) > + > AC_ARG_ENABLE(tracer, AC_HELP_STRING([--enable-tracer], [install Tracing daemon]), [ > tracer_enable=${enableval} > ]) > @@ -372,6 +377,10 @@ AC_DEFUN([AC_ARG_BLUEZ], [ > AC_DEFINE(HAVE_LIBUSB, 1, [Define to 1 if you have USB library.]) > fi > > + if (test "${sixaxis_enable}" = "yes" && test "${udev_found}" = "yes"); then > + AC_DEFINE(HAVE_SIXAXIS_PLUGIN, 1, [Define to 1 if you have sixaxis plugin.]) > + fi > + > AM_CONDITIONAL(SNDFILE, test "${sndfile_enable}" = "yes" && test "${sndfile_found}" = "yes") > AM_CONDITIONAL(USB, test "${usb_enable}" = "yes" && test "${usb_found}" = "yes") > AM_CONDITIONAL(SBC, test "${alsa_enable}" = "yes" || test "${gstreamer_enable}" = "yes" || > @@ -406,4 +415,5 @@ AC_DEFUN([AC_ARG_BLUEZ], [ > AM_CONDITIONAL(CONFIGFILES, test "${configfiles_enable}" = "yes") > AM_CONDITIONAL(MAEMO6PLUGIN, test "${maemo6_enable}" = "yes") > AM_CONDITIONAL(DBUSOOBPLUGIN, test "${dbusoob_enable}" = "yes") > + AM_CONDITIONAL(SIXAXISPLUGIN, test "${sixaxis_enable}" = "yes" && test "${udev_found}" = "yes") > ]) > diff --git a/plugins/sixaxis.c b/plugins/sixaxis.c > new file mode 100644 > index 0000000..70f81f4 > --- /dev/null > +++ b/plugins/sixaxis.c > @@ -0,0 +1,528 @@ > +/* > + * sixaxis plugin: do cable association for Sixaxis controller > + * > + * Copyright (C) 2009 Bastien Nocera <hadess@xxxxxxxxxx> > + * Copyright (C) 2011 Antonio Ospite <ospite@xxxxxxxxxxxxxxxxx> > + * > + * > + * This program is free software; you can redistribute it and/or modify > + * it under the terms of the GNU General Public License as published by > + * the Free Software Foundation; either version 2 of the License, or > + * (at your option) any later version. > + * > + * 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. > + * > + * You should have received a copy of the GNU General Public License > + * along with this program; if not, write to the Free Software > + * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA > + * > + */ > + > +/* > + * In the following this terminology is used: > + * > + * - controller: a Sixaxis joypad. > + * - adapter: the bluetooth dongle on the host system. > + * - adapter_bdaddr: the bdaddr of the bluetooth adapter. > + * - device_bdaddr: the bdaddr of the Sixaxis controller. > + * - master_bdaddr: the bdaddr of the adapter to be configured into the > + * Sixaxis controller > + */ > + > +#ifdef HAVE_CONFIG_H > +#include <config.h> > +#endif > + > +#include <stdio.h> > +#include <stdint.h> > +#include <stdlib.h> > +#include <sys/ioctl.h> > +#include <sys/types.h> > +#include <sys/stat.h> > +#include <fcntl.h> > +#include <unistd.h> > +#include <glib.h> > +#include <linux/hidraw.h> > + > +#define LIBUDEV_I_KNOW_THE_API_IS_SUBJECT_TO_CHANGE 1 > +#include <libudev.h> > + > +#include "plugin.h" > +#include "log.h" > +#include "adapter.h" > +#include "device.h" > +#include "manager.h" > +#include "storage.h" > +#include "sdp_lib.h" > + > +/* Fallback definitions to compile with older headers */ > +#ifndef HIDIOCGFEATURE > +#define HIDIOCGFEATURE(len) _IOC(_IOC_WRITE|_IOC_READ, 'H', 0x07, len) > +#endif > + > +#ifndef HIDIOCSFEATURE > +#define HIDIOCSFEATURE(len) _IOC(_IOC_WRITE|_IOC_READ, 'H', 0x06, len) > +#endif > + > + > +#define BDADDR_STR_SIZE 18 /* strlen("00:00:00:00:00:00") + 1 */ > + > +/* Vendor and product ID for the Sixaxis PS3 controller */ > +#define VENDOR 0x054c > +#define PRODUCT 0x0268 > +#define SIXAXIS_NAME "PLAYSTATION(R)3 Controller" > +#define SIXAXIS_PNP_RECORD "3601920900000A000100000900013503191124090004350D35061901000900113503190011090006350909656E09006A0901000900093508350619112409010009000D350F350D350619010009001335031900110901002513576972656C65737320436F6E74726F6C6C65720901012513576972656C65737320436F6E74726F6C6C6572090102251B536F6E7920436F6D707574657220456E7465727461696E6D656E740902000901000902010901000902020800090203082109020428010902052801090206359A35980822259405010904A101A102850175089501150026FF00810375019513150025013500450105091901291381027501950D0600FF8103150026FF0005010901A10075089504350046FF0009300931093209358102C0050175089527090181027508953009019102750895300901B102C0A1028502750895300901B102C0A10285EE750895300901B102C0A10285EF750895300901B102C0C0090207350835060904090901000902082800090209280109020A280109020B09010009020C093E8009020D280009020E2800" > +#define HID_UUID "00001124-0000-1000-8000-00805f9b34fb" > + > +static int create_sixaxis_association(struct btd_adapter *adapter, > + const char *name, > + const char *address, > + guint32 vendor_id, > + guint32 product_id, > + const char *pnp_record) Use only tabs for indentation. > +{ > + DBusConnection *conn; > + sdp_record_t *rec; > + struct btd_device *device; > + bdaddr_t src, dst; > + char srcaddr[18]; > + int ret = 0; The most common idiom is to call this kind of variable 'err'. > + > + str2ba(address, &dst); > + adapter_get_address(adapter, &src); > + ba2str(&src, srcaddr); > + > + write_device_name(&dst, &src, (char *) name); > + > + /* Store the device's SDP record */ > + rec = record_from_string(pnp_record); > + store_record(srcaddr, address, rec); > + sdp_record_free(rec); > + > + /* Set the device id */ > + store_device_id(srcaddr, address, 0xffff, vendor_id, product_id, 0); > + /* Don't write a profile, it will be updated when the device connects */ > + > + write_trust(srcaddr, address, "[all]", TRUE); > + > + conn = dbus_bus_get(DBUS_BUS_SYSTEM, NULL); > + if (conn == NULL) { > + DBG("Failed to get on the bus"); > + ret = -1; If possible, use a more descriptive error number, -EPERM perhaps? > + goto fail_dbus; > + } > + > + device = adapter_get_device(conn, adapter, address); > + if (device == NULL) { > + DBG("Failed to get the device"); > + ret = -1; Same here. > + goto fail_device; > + } > + > + device_set_temporary(device, FALSE); > + device_set_name(device, name); > + btd_device_add_uuid(device, HID_UUID); > + > +fail_device: > + dbus_connection_unref(conn); > +fail_dbus: > + return ret; > +} > + > + Extra empty line here. > +/* Usb cable pairing section */ > +static unsigned char *get_feature_report(int fd, uint8_t report_number, unsigned int len) Try to keep lines under the 78 characters limit. There are more places like this, I might have missed some. > +{ > + unsigned char *buf; > + int ret; > + > + buf = calloc(len, sizeof(*buf)); Usually in BlueZ code we try to use the allocations function provided by GLib, g_malloc0() in this case. > + if (buf == NULL) { > + error("%s:%s() calloc failed", __FILE__, __func__); > + return NULL; > + } > + > + buf[0] = report_number; > + > + ret = ioctl(fd, HIDIOCGFEATURE(len), buf); > + if (ret < 0) { > + error("%s:%s() HIDIOCGFEATURE ret = %d", __FILE__, __func__, ret); > + free(buf); > + return NULL; > + } > + > + return buf; > +} > + > +static int set_feature_report(int fd, uint8_t *report, int len) > +{ > + int ret; > + > + ret = ioctl(fd, HIDIOCSFEATURE(len), report); > + if (ret < 0) > + error("%s:%s() HIDIOCSFEATURE failed, ret = %d", > + __FILE__, __func__, ret); > + > + return ret; > +} > + > +static char *get_device_bdaddr(int fd) > +{ > + unsigned char *buf; > + char *address; > + > + buf = get_feature_report(fd, 0xf2, 18); > + if (buf == NULL) { > + error("%s:%s() cannot get feature report", __FILE__, __func__); > + return NULL; > + } > + > + address = calloc(BDADDR_STR_SIZE, sizeof(*address)); Same here. > + if (address == NULL) { > + error("%s:%s() calloc failed", __FILE__, __func__); > + free(buf); > + return NULL; > + } > + > + snprintf(address, BDADDR_STR_SIZE, > + "%02X:%02X:%02X:%02X:%02X:%02X", > + buf[4], buf[5], buf[6], buf[7], buf[8], buf[9]); Just tabs for indentation. > + > + free(buf); > + return address; > +} > + > +static int set_master_bdaddr(int fd, char *adapter_bdaddr) > +{ > + uint8_t *report; > + uint8_t addr[6]; > + int ret; > + > + ret = sscanf(adapter_bdaddr, "%02hhx:%02hhx:%02hhx:%02hhx:%02hhx:%02hhx", > + &addr[0], &addr[1], &addr[2], &addr[3], &addr[4], &addr[5]); Same here. > + if (ret != 6) { > + Extra empty line. > + error("%s:%s() Parsing the bt address failed", __FILE__, __func__); > + return FALSE; > + } > + > + report = malloc(8); g_malloc0()? > + if (report == NULL) { > + error("%s:%s() malloc failed", __FILE__, __func__); > + return FALSE; > + } > + > + report[0] = 0xf5; > + report[1] = 0x01; > + > + report[2] = addr[0]; > + report[3] = addr[1]; > + report[4] = addr[2]; > + report[5] = addr[3]; > + report[6] = addr[4]; > + report[7] = addr[5]; > + > + ret = set_feature_report(fd, report, 8); > + if (ret < 0) { > + error("%s:%s() cannot set feature report", __FILE__, __func__); > + goto out; > + } > + > + DBG("New Master Bluetooth address: %s", adapter_bdaddr); > + > +out: > + free(report); > + return ret; > +} > + > +static int sixpair(int fd, struct btd_adapter *adapter) > +{ > + char *device_bdaddr; > + char adapter_bdaddr[18]; > + bdaddr_t dst; > + int ret = 0; Call this 'err'. > + > + adapter_get_address(adapter, &dst); > + ba2str(&dst, adapter_bdaddr); > + DBG("Adapter bdaddr %s", adapter_bdaddr); > + > + ret = set_master_bdaddr(fd, adapter_bdaddr); > + if (ret < 0) { > + DBG("Failed to set the master Bluetooth address"); > + return ret; > + } > + > + device_bdaddr = get_device_bdaddr(fd); > + if (device_bdaddr == NULL) { > + DBG("Failed to get the Bluetooth address from the device"); > + return -1; > + } > + > + DBG("Device bdaddr %s", device_bdaddr); > + > + ret = create_sixaxis_association(adapter, > + SIXAXIS_NAME, > + device_bdaddr, > + VENDOR, PRODUCT, SIXAXIS_PNP_RECORD); Spaces for indentation. > + free(device_bdaddr); > + return ret; > +} > + Extra empty line. > + > +/* Led setting section */ > +#define LED_1 (0x01 << 1) > +#define LED_2 (0x01 << 2) > +#define LED_3 (0x01 << 3) > +#define LED_4 (0x01 << 4) > + > +#define LED_STATUS_OFF 0 > +#define LED_STATUS_ON 1 > + Move these declarations to the top. > +static int set_leds(int fd, unsigned char leds_status[4]) > +{ > + int ret; > + > + /* > + * the total time the led is active (0xff means forever) > + * | duty_length: how long a cycle is in deciseconds (0 means "blink really fast") > + * | | ??? (Some form of phase shift or duty_length multiplier?) > + * | | | % of duty_length the led is off (0xff means 100%) > + * | | | | % of duty_length the led is on (0xff mean 100%) > + * | | | | | > + * 0xff, 0x27, 0x10, 0x00, 0x32, > + */ > + unsigned char leds_report[] = { > + 0x01, > + 0x00, 0x00, 0x00, 0x00, 0x00, /* rumble values TBD */ > + 0x00, 0x00, 0x00, 0x00, 0x1e, /* LED_1 = 0x02, LED_2 = 0x04, ... */ > + 0xff, 0x27, 0x10, 0x00, 0x32, /* LED_4 */ > + 0xff, 0x27, 0x10, 0x00, 0x32, /* LED_3 */ > + 0xff, 0x27, 0x10, 0x00, 0x32, /* LED_2 */ > + 0xff, 0x27, 0x10, 0x00, 0x32, /* LED_1 */ > + 0x00, 0x00, 0x00, 0x00, 0x00, > + }; > + > + int leds = 0; > + if (leds_status[0]) > + leds |= LED_1; > + if (leds_status[1]) > + leds |= LED_2; > + if (leds_status[2]) > + leds |= LED_3; > + if (leds_status[3]) > + leds |= LED_4; > + > + leds_report[10] = leds; > + > + ret = write(fd, leds_report, sizeof(leds_report)); > + if (ret < (ssize_t) sizeof(leds_report)) > + error("%s:%s() Unable to write to hidraw device", __FILE__, __func__); > + > + return ret; > +} > + > +static int set_controller_number(int fd, unsigned int n) > +{ > + unsigned char leds_status[4] = {0, 0, 0, 0}; > + > + switch (n) { > + case 0: > + break; > + case 1: > + case 2: > + case 3: > + case 4: > + leds_status[n - 1] = LED_STATUS_ON; > + break; > + case 5: > + case 6: > + case 7: > + leds_status[4 - 1] = LED_STATUS_ON; > + leds_status[n - 4 - 1] = LED_STATUS_ON; > + break; > + default: > + error("%s:%s() Only 7 controllers supported for now", __FILE__, __func__); > + return -1; > + } > + > + return set_leds(fd, leds_status); > +} > + > + > +static void handle_device_plug(struct udev_device *udevice) > +{ > + struct udev_device *hid_parent; > + struct udev_enumerate *enumerate; > + struct udev_list_entry *devices, *dev_list_entry; > + const char *hid_phys; > + const char *hidraw_node; > + unsigned char is_usb = FALSE; > + int js_num = 0; > + int fd; > + > + hid_parent = udev_device_get_parent_with_subsystem_devtype(udevice, "hid", NULL); > + if (!hid_parent) { > + error("%s:%s() cannot get parent hid device", __FILE__, __func__); > + return; > + } > + > + DBG("name: %s", udev_device_get_property_value(hid_parent, "HID_NAME")); > + > + if (!(g_str_has_suffix(udev_device_get_property_value(hid_parent, "HID_NAME"), > + "PLAYSTATION(R)3 Controller") || > + g_str_has_suffix(udev_device_get_property_value(hid_parent, "HID_NAME"), > + "Sony Computer Entertainment Wireless Controller")) > + ) The coding style here is confusing, and I think that if you add a variable to store the value of 'udev_get_property_value(hid_parent, "HID_NAME")' things would look simpler. > + return; > + > + DBG("Found a Sixaxis device"); > + > + hidraw_node = udev_device_get_devnode(udevice); > + > + hid_phys = udev_device_get_property_value(hid_parent, "HID_PHYS"); > + > + /* looking for joysticks */ > + enumerate = udev_enumerate_new(udev_device_get_udev(udevice)); > + udev_enumerate_add_match_sysname(enumerate, "js*"); > + udev_enumerate_scan_devices(enumerate); > + > + devices = udev_enumerate_get_list_entry(enumerate); > + udev_list_entry_foreach(dev_list_entry, devices) { > + const char *devname; > + struct udev_device *js_dev; > + struct udev_device *input_parent; > + const char *input_phys; > + > + devname = udev_list_entry_get_name(dev_list_entry); > + js_dev = udev_device_new_from_syspath(udev_device_get_udev(udevice), devname); > + > + input_parent = udev_device_get_parent_with_subsystem_devtype(js_dev, "input", NULL); > + if (!input_parent) { > + error("%s:%s() cannot get parent input device.", __FILE__, __func__); > + continue; > + } > + > + /* check this is the joystick relative to the hidraw device above */ > + input_phys = udev_device_get_sysattr_value(input_parent, "phys"); > + if (g_strcmp0(input_phys, hid_phys) == 0) { > + js_num = atoi(udev_device_get_sysnum(js_dev)) + 1; > + DBG("joypad device_num: %d", js_num); > + DBG("hidraw_node: %s", hidraw_node); > + DBG("driver: %s", > + udev_device_get_property_value(js_dev, "ID_USB_DRIVER")); > + > + if (g_strcmp0(udev_device_get_property_value(js_dev, "ID_USB_DRIVER"), > + "usbhid") == 0) I guess you already know what I am going to say ;-) > + is_usb = TRUE; > + } > + > + udev_device_unref(js_dev); > + } > + > + udev_enumerate_unref(enumerate); > + > + fd = open(hidraw_node, O_RDWR); > + if (fd < 0) { > + error("%s:%s() hidraw open", __FILE__, __func__); > + return; > + } > + > + if (js_num > 0) > + set_controller_number(fd, js_num); > + if (is_usb) { > + struct btd_adapter *adapter; > + > + /* Look for the default adapter */ > + adapter = manager_get_default_adapter(); > + if (adapter == NULL) { > + DBG("No adapters, exiting"); > + return; > + } > + sixpair(fd, adapter); > + } > + > + close(fd); > +} > + > +static gboolean device_event_idle(struct udev_device *udevice) > +{ > + handle_device_plug(udevice); > + udev_device_unref(udevice); > + return FALSE; > +} > + > +static struct udev *ctx = NULL; > +static struct udev_monitor *monitor = NULL; > +static guint watch_id = 0; Move these to the top, globals should be really visible. > + > +static gboolean > +monitor_event(GIOChannel *source, > + GIOCondition condition, > + gpointer data) These declaration isn't consistent with the rest of the BlueZ coding style. > +{ > + struct udev_device *udevice; > + > + udevice = udev_monitor_receive_device(monitor); > + if (udevice == NULL) > + goto out; > + if (g_strcmp0(udev_device_get_action(udevice), "add") != 0) { > + udev_device_unref(udevice); > + goto out; > + } > + > + g_timeout_add_seconds(1, (GSourceFunc) device_event_idle, udevice); Just a question: why is this delay between finding the device and plug'ing it is needed? Perhaps a short comment explaining why it is needed would be nice. > + > +out: > + return TRUE; > +} > + > + Extra empty line. > +static int sixaxis_init(void) > +{ > + GIOChannel *channel; > + > + DBG("Setup Sixaxis cable plugin"); > + > + ctx = udev_new(); > + monitor = udev_monitor_new_from_netlink(ctx, "udev"); > + if (monitor == NULL) { > + error("%s:%s() Could not get udev monitor", __FILE__, __func__); > + return -1; > + } > + > + /* Listen for newly connected hidraw interfaces */ > + udev_monitor_filter_add_match_subsystem_devtype(monitor, > + "hidraw", NULL); > + udev_monitor_enable_receiving(monitor); > + > + channel = g_io_channel_unix_new(udev_monitor_get_fd(monitor)); > + watch_id = g_io_add_watch(channel, G_IO_IN, monitor_event, NULL); > + g_io_channel_unref(channel); > + > + return 0; > +} > + > +static void sixaxis_exit(void) > +{ > + DBG("Cleanup Sixaxis cable plugin"); > + > + if (watch_id != 0) { > + g_source_remove(watch_id); > + watch_id = 0; > + } > + if (monitor != NULL) { > + udev_monitor_unref(monitor); > + monitor = NULL; > + } > + if (ctx != NULL) { > + udev_unref(ctx); > + ctx = NULL; > + } > +} > + > +BLUETOOTH_PLUGIN_DEFINE(sixaxis, VERSION, > + BLUETOOTH_PLUGIN_PRIORITY_DEFAULT, > + sixaxis_init, sixaxis_exit) > -- > 1.7.5.3 > > -- > To unsubscribe from this list: send the line "unsubscribe linux-bluetooth" in > the body of a message to majordomo@xxxxxxxxxxxxxxx > More majordomo info at http://vger.kernel.org/majordomo-info.html Cheers, -- Vinicius -- To unsubscribe from this list: send the line "unsubscribe linux-input" in the body of a message to majordomo@xxxxxxxxxxxxxxx More majordomo info at http://vger.kernel.org/majordomo-info.html