Diff: USBJoystick.cpp

Revision:

0:e086541742c3

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/USBJoystick.cpp	Thu Jan 05 14:22:02 2017 +0000
@@ -0,0 +1,252 @@
+/* mbed USBJoystick Library
+ * Copyright (c) 2012, v01:  Initial version, WH,
+ *                           Modified USBMouse code ARM Limited.
+ *                           (c) 2010-2011 mbed.org, MIT License
+ *               2016, v02:  Updated USBDevice Lib, Added waitForConnect, Updated 32 bits button 
+ *
+ * Permission is hereby granted, free of charge, to any person obtaining a copy
+ * of this software and associated documentation files (the "Software"), to deal
+ * in the Software without restriction, inclumosig without limitation the rights
+ * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
+ * copies of the Software, and to permit persons to whom the Software is
+ * furnished to do so, subject to the following conditions:
+ *
+ * The above copyright notice and this permission notice shall be included in
+ * all copies or substantial portions of the Software.
+ *
+ * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
+ * IMPLIED, INCLUmosiG BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
+ * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
+ * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
+ * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
+ * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
+ * THE SOFTWARE.
+ */
+
+
+#include "stdint.h"
+#include "USBJoystick.h"
+
+bool USBJoystick::update(int16_t t, int16_t r, int16_t x, int16_t y, uint32_t buttons, uint8_t hat) {
+
+   _t = t;
+   _r = r;   
+   _x = x;
+   _y = y;
+   _buttons = buttons;     
+   _hat = hat;
+
+   return update();
+}
+ 
+bool USBJoystick::update() {
+   HID_REPORT report;
+
+   // Fill the report according to the Joystick Descriptor
+   report.data[0] = _t & 0xff;            
+   report.data[1] = _r & 0xff;               
+   report.data[2] = _x & 0xff;            
+   report.data[3] = _y & 0xff;
+
+
+#if (BUTTONS4 == 1)               
+//Hat and 4 Buttons
+//   report.data[4] = ((_buttons & 0x0f) << 4) | (_hat & 0x0f) ;                                      
+//   report.length = 5; 
+
+
+//Use 4 bit padding for hat4 or hat8
+   report.data[4] = (_hat & 0x0f) ;                                      
+
+//Use 4 bit padding for buttons   
+   report.data[5] = (_buttons & 0x0f) ;                                         
+   report.length = 6; 
+#endif
+
+#if (BUTTONS8 == 1)               
+//Hat and first 4 Buttons
+//   report.data[4] = ((_buttons & 0x0f) << 4) | (_hat & 0x0f) ;                                      
+//
+//Use bit padding for last 4 Buttons
+//   report.data[5] =  (_buttons & 0xf0) >> 4;                                         
+//   report.length = 6; 
+
+//Use 4 bit padding for hat4 or hat8
+   report.data[4] = (_hat & 0x0f) ;                                      
+
+//Use 8 bits for buttons   
+   report.data[5] = (_buttons & 0xff) ;
+   report.length = 6;
+#endif
+
+#if (BUTTONS32 == 1)               
+//Use 4 bit padding for hat4 or hat8
+   report.data[4] = (_hat & 0x0f) ;
+
+//No bit padding for 32 buttons                                         
+   report.data[5] = (_buttons >>  0) & 0xff;
+   report.data[6] = (_buttons >>  8) & 0xff;
+   report.data[7] = (_buttons >> 16) & 0xff;
+   report.data[8] = (_buttons >> 24) & 0xff;
+   report.length = 9;
+#endif
+       
+   return send(&report);
+}
+
+bool USBJoystick::throttle(int16_t t) {
+     _t = t;
+   return update();
+}
+
+bool USBJoystick::rudder(int16_t r) {
+   _r = r;
+   return update();
+}
+
+bool USBJoystick::move(int16_t x, int16_t y) {
+   _x = x;
+   _y = y;
+   return update();
+}
+
+bool USBJoystick::buttons(uint32_t buttons) {
+   _buttons = buttons;
+   return update();
+}
+
+bool USBJoystick::hat(uint8_t hat) {
+   _hat = hat;
+   return update();
+}
+
+
+void USBJoystick::_init() {
+   _t = -127;
+   _r = -127;    
+   _x = 0;                       
+   _y = 0;     
+   _buttons = 0x00000000;
+   _hat = 0x00;              
+}
+
+
+uint8_t * USBJoystick::reportDesc() {    
+         static uint8_t reportDescriptor[] = {
+
+             USAGE_PAGE(1), 0x01,           // Generic Desktop           
+             LOGICAL_MINIMUM(1), 0x00,      // Logical_Minimum (0)             
+             USAGE(1), 0x04,                // Usage (Joystick)
+             COLLECTION(1), 0x01,           // Application
+               USAGE_PAGE(1), 0x02,            // Simulation Controls
+               USAGE(1), 0xBB,                 // Throttle             
+               USAGE(1), 0xBA,                 // Rudder               
+               LOGICAL_MINIMUM(1), 0x81,       // -127
+               LOGICAL_MAXIMUM(1), 0x7f,       // 127
+               REPORT_SIZE(1), 0x08,
+               REPORT_COUNT(1), 0x02,
+               INPUT(1), 0x02,                 // Data, Variable, Absolute               
+               USAGE_PAGE(1), 0x01,            // Generic Desktop
+               USAGE(1), 0x01,                 // Usage (Pointer)
+               COLLECTION(1), 0x00,            // Physical
+                 USAGE(1), 0x30,                 // X
+                 USAGE(1), 0x31,                 // Y
+//  8 bit values
+                 LOGICAL_MINIMUM(1), 0x81,       // -127
+                 LOGICAL_MAXIMUM(1), 0x7f,       // 127
+                 REPORT_SIZE(1), 0x08,
+                 REPORT_COUNT(1), 0x02,
+                 INPUT(1), 0x02,                 // Data, Variable, Absolute                  
+// 16 bit values
+//                 LOGICAL_MINIMUM(1), 0x00,       // 0
+//                 LOGICAL_MAXIMUM(2), 0xff, 0x7f, // 32767
+//                 REPORT_SIZE(1), 0x10,
+//                 REPORT_COUNT(1), 0x02,
+//                 INPUT(1), 0x02,                 // Data, Variable, Absolute                
+
+               END_COLLECTION(0),               
+
+#if (HAT4 == 1)
+// 4 Position Hat Switch
+               USAGE(1), 0x39,                 // Usage (Hat switch)
+               LOGICAL_MINIMUM(1), 0x00,       // 0
+               LOGICAL_MAXIMUM(1), 0x03,       // 3
+               PHYSICAL_MINIMUM(1), 0x00,      // Physical_Minimum (0)
+               PHYSICAL_MAXIMUM(2), 0x0E, 0x01, // Physical_Maximum (270)
+               UNIT(1), 0x14,                  // Unit (Eng Rot:Angular Pos)                            
+               REPORT_SIZE(1), 0x04,
+               REPORT_COUNT(1), 0x01,
+               INPUT(1), 0x02,                 // Data, Variable, Absolute               
+#endif
+#if (HAT8 == 1)
+// 8 Position Hat Switch
+               USAGE(1), 0x39,                 // Usage (Hat switch)
+               LOGICAL_MINIMUM(1), 0x00,       // 0
+               LOGICAL_MAXIMUM(1), 0x07,       // 7
+               PHYSICAL_MINIMUM(1), 0x00,      // Physical_Minimum (0)
+               PHYSICAL_MAXIMUM(2), 0x3B, 0x01, // Physical_Maximum (315)
+               UNIT(1), 0x14,                  // Unit (Eng Rot:Angular Pos)                            
+               REPORT_SIZE(1), 0x04,
+               REPORT_COUNT(1), 0x01,
+               INPUT(1), 0x02,                 // Data, Variable, Absolute               
+#endif
+
+// Padding 4 bits
+               REPORT_SIZE(1), 0x01,
+               REPORT_COUNT(1), 0x04,
+               INPUT(1), 0x01,                 // Constant
+
+
+#if (BUTTONS4 == 1)
+// 4 Buttons
+               USAGE_PAGE(1), 0x09,            // Buttons
+               USAGE_MINIMUM(1), 0x01,         // 1
+               USAGE_MAXIMUM(1), 0x04,         // 4
+               LOGICAL_MINIMUM(1), 0x00,       // 0
+               LOGICAL_MAXIMUM(1), 0x01,       // 1
+               REPORT_SIZE(1), 0x01,
+               REPORT_COUNT(1), 0x04,
+               UNIT_EXPONENT(1), 0x00,         // Unit_Exponent (0)
+               UNIT(1), 0x00,                  // Unit (None)                                           
+               INPUT(1), 0x02,                 // Data, Variable, Absolute
+
+// Padding 4 bits
+               REPORT_SIZE(1), 0x01,
+               REPORT_COUNT(1), 0x04,
+               INPUT(1), 0x01,                 // Constant
+
+#endif
+#if (BUTTONS8 == 1)
+// 8 Buttons
+               USAGE_PAGE(1), 0x09,            // Buttons
+               USAGE_MINIMUM(1), 0x01,         // 1
+               USAGE_MAXIMUM(1), 0x08,         // 8
+               LOGICAL_MINIMUM(1), 0x00,       // 0
+               LOGICAL_MAXIMUM(1), 0x01,       // 1
+               REPORT_SIZE(1), 0x01,
+               REPORT_COUNT(1), 0x08,
+               UNIT_EXPONENT(1), 0x00,         // Unit_Exponent (0)
+               UNIT(1), 0x00,                  // Unit (None)                                           
+               INPUT(1), 0x02,                 // Data, Variable, Absolute
+#endif
+
+#if (BUTTONS32 == 1)
+// 32 Buttons
+               USAGE_PAGE(1), 0x09,            // Buttons
+               USAGE_MINIMUM(1), 0x01,         // 1
+               USAGE_MAXIMUM(1), 0x20,         // 32
+               LOGICAL_MINIMUM(1), 0x00,       // 0
+               LOGICAL_MAXIMUM(1), 0x01,       // 1
+               REPORT_SIZE(1), 0x01,
+               REPORT_COUNT(1), 0x20,
+               UNIT_EXPONENT(1), 0x00,         // Unit_Exponent (0)
+               UNIT(1), 0x00,                  // Unit (None)                                           
+               INPUT(1), 0x02,                 // Data, Variable, Absolute
+#endif
+
+             END_COLLECTION(0)
+      };
+
+      reportLength = sizeof(reportDescriptor);
+      return reportDescriptor;
+}