Firestorm Dual Power support

TODO

@@ -9,6 +9,8 @@ Pre Release Testing:
 Stuff to do before 0.5 release:
 ===============================
 
+* fix names in non '--silent' output to match names used for button bindings
+
 * print unused dummy bytes
 
 * add a way to not create a joystick/event device

src/firestorm_dual_controller.cpp

@@ -0,0 +1,159 @@
+/* 
+**  Xbox/Xbox360 USB Gamepad Userspace Driver
+**  Copyright (C) 2008 Ingo Ruhnke <grumbel@gmx.de>
+**
+**  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 3 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, see <http://www.gnu.org/licenses/>.
+*/
+
+#include <iostream>
+#include <errno.h>
+#include <stdexcept>
+#include <sstream>
+#include <string.h>
+#include "firestorm_dual_controller.hpp"
+
+struct FirestormMsg
+{
+  unsigned int a   :1;
+  unsigned int x   :1;
+  unsigned int b   :1;
+  unsigned int y   :1;
+
+  unsigned int lb  :1;
+  unsigned int lt  :1;
+  unsigned int rb  :1;
+  unsigned int rt  :1;
+
+  unsigned int back  :1;
+  unsigned int start :1;
+  
+  unsigned int thumb_l :1;
+  unsigned int thumb_r :1;
+
+  unsigned int dummy :4;
+
+  unsigned int dpad :8; // 0xf0 == center, 0x00 == up, clockwise + 10 each
+
+  int x1 :8;
+  int y1 :8;
+  int x2 :8;
+  unsigned int y2 :8;
+} __attribute__((__packed__));
+
+FirestormDualController::FirestormDualController(struct usb_device* dev)
+{
+  handle = usb_open(dev);
+  if (!handle)
+    {
+      throw std::runtime_error("Error opening FirestormDualController");
+    }
+  else
+    {
+      //usb_detach_kernel_driver_np(handle, 0);
+
+      int err = usb_claim_interface(handle, 0);
+      if (err != 0) 
+        {
+          std::ostringstream out;
+          out << "Error couldn't claim the USB interface: " << strerror(-err) << std::endl
+              << "Try to run 'rmmod xpad' and start xboxdrv again.";
+          throw std::runtime_error(out.str());
+        }    
+    }
+}
+
+FirestormDualController::~FirestormDualController()
+{
+  usb_release_interface(handle, 0); 
+  usb_close(handle);
+}
+
+void
+FirestormDualController::set_rumble(uint8_t left, uint8_t right)
+{
+  char cmd[] = { left, right, 0x00, 0x00 };
+  usb_control_msg(handle, 0x21, 0x09, 0x02, 0x00, cmd, sizeof(cmd), 0);
+}
+
+void
+FirestormDualController::set_led(uint8_t status)
+{
+  // not supported
+}
+
+bool
+FirestormDualController::read(XboxGenericMsg& msg, bool verbose, int timeout)
+{
+  FirestormMsg data;
+  int ret = usb_interrupt_read(handle, 1 /*EndPoint*/, (char*)&data, sizeof(data), timeout);
+
+  if (ret == -ETIMEDOUT)
+    {
+      return false;
+    }
+  else if (ret < 0)
+    { // Error
+      std::ostringstream str;
+      str << "USBError: " << ret << "\n" << usb_strerror();
+      throw std::runtime_error(str.str());
+    }
+  else if (ret == sizeof(data))
+    {
+      memset(&msg, 0, sizeof(msg));
+      msg.type    = GAMEPAD_XBOX360;
+
+      msg.xbox360.a = data.a;
+      msg.xbox360.b = data.b;
+      msg.xbox360.x = data.x;
+      msg.xbox360.y = data.y;
+
+      msg.xbox360.lb = data.lb;
+      msg.xbox360.rb = data.rb;
+
+      msg.xbox360.lt = data.lt << 8;
+      msg.xbox360.rt = data.rt << 8;
+
+      msg.xbox360.start = data.start;
+      msg.xbox360.back  = data.back;
+
+      msg.xbox360.thumb_l = data.thumb_l;
+      msg.xbox360.thumb_r = data.thumb_r;
+
+      msg.xbox360.x1 = data.x1 << 8;
+      msg.xbox360.y1 = data.y1 << 8;
+
+      msg.xbox360.x2 = data.x2 << 8;
+      msg.xbox360.y2 = (data.y2 - 128) << 8;
+
+      if (data.dpad == 0x00 || data.dpad == 0x70 || data.dpad == 0x10)
+        msg.xbox360.dpad_up   = 1;
+
+      if (data.dpad == 0x10 || data.dpad == 0x20 || data.dpad == 0x30)
+        msg.xbox360.dpad_right = 1;
+
+      if (data.dpad == 0x30 || data.dpad == 0x40 || data.dpad == 0x50)
+        msg.xbox360.dpad_down = 1;
+      
+      if (data.dpad == 0x50 || data.dpad == 0x60 || data.dpad == 0x70)
+        msg.xbox360.dpad_left  = 1;
+
+      return true;
+    }
+  else
+    {
+      return false;
+    }
+}
+
+/* EOF */

src/firestorm_dual_controller.hpp

@@ -0,0 +1,45 @@
+/* 
+**  Xbox/Xbox360 USB Gamepad Userspace Driver
+**  Copyright (C) 2008 Ingo Ruhnke <grumbel@gmx.de>
+**
+**  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 3 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, see <http://www.gnu.org/licenses/>.
+*/
+
+#ifndef HEADER_FIRESTORM_DUAL_CONTROLLER_HPP
+#define HEADER_FIRESTORM_DUAL_CONTROLLER_HPP
+
+#include <usb.h>
+#include "xboxmsg.hpp"
+#include "xbox_generic_controller.hpp"
+
+class FirestormDualController : public XboxGenericController
+{
+private:
+  struct usb_device* dev;
+  struct usb_dev_handle* handle;
+
+public:
+  FirestormDualController(struct usb_device* dev);
+  ~FirestormDualController();
+
+  void set_rumble(uint8_t left, uint8_t right);
+  void set_led(uint8_t status);
+
+  /** @param timeout   timeout in msec, 0 means forever */
+  bool read(XboxGenericMsg& msg, bool verbose, int timeout);
+};
+
+#endif
+
+/* EOF */