return ret;
}
-static gboolean setup_leds(GIOChannel *channel, GIOCondition cond,
- gpointer user_data)
+static void set_leds_hidraw(int fd, int number)
{
/*
* the total time the led is active (0xff means forever)
0xff, 0x27, 0x10, 0x00, 0x32, /* LED_1 */
0x00, 0x00, 0x00, 0x00, 0x00,
};
- int number = GPOINTER_TO_INT(user_data);
int ret;
- int fd;
-
- if (cond & (G_IO_HUP | G_IO_ERR | G_IO_NVAL))
- return FALSE;
-
- DBG("number %d", number);
/* TODO we could support up to 10 (1 + 2 + 3 + 4) */
if (number > 7)
- return FALSE;
+ return;
if (number > 4) {
leds_report[10] |= 0x10;
leds_report[10] |= 0x01 << number;
- fd = g_io_channel_unix_get_fd(channel);
-
ret = write(fd, leds_report, sizeof(leds_report));
if (ret == sizeof(leds_report))
- return FALSE;
+ return;
if (ret < 0)
error("sixaxis: failed to set LEDS (%s)", strerror(errno));
else
error("sixaxis: failed to set LEDS (%d bytes written)", ret);
+}
+
+static gboolean setup_leds(GIOChannel *channel, GIOCondition cond,
+ gpointer user_data)
+{
+ int number = GPOINTER_TO_INT(user_data);
+ int fd;
+
+ if (cond & (G_IO_HUP | G_IO_ERR | G_IO_NVAL))
+ return FALSE;
+
+ DBG("number %d", number);
+
+ fd = g_io_channel_unix_get_fd(channel);
+ set_leds_hidraw(fd, number);
return FALSE;
}