Added basic hid gamepad example

example/hid_gamepad_example.c

@@ -0,0 +1,183 @@
+/*
+ * Copyright (C) 2014 BlueKitchen GmbH
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions
+ * are met:
+ *
+ * 1. Redistributions of source code must retain the above copyright
+ *    notice, this list of conditions and the following disclaimer.
+ * 2. Redistributions in binary form must reproduce the above copyright
+ *    notice, this list of conditions and the following disclaimer in the
+ *    documentation and/or other materials provided with the distribution.
+ * 3. Neither the name of the copyright holders nor the names of
+ *    contributors may be used to endorse or promote products derived
+ *    from this software without specific prior written permission.
+ * 4. Any redistribution, use, or modification is done solely for
+ *    personal benefit and not for any commercial purpose or for
+ *    monetary gain.
+ *
+ * THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS
+ * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
+ * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
+ * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS
+ * RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
+ * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
+ * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
+ * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
+ * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
+ * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF
+ * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
+ * SUCH DAMAGE.
+ *
+ * Please inquire about commercial licensing options at 
+ * [email protected]
+ *
+ */
+
+#define __BTSTACK_FILE__ "hid_gamepad_example.c"
+
+#include <stdint.h>
+#include <stdio.h>
+#include <stdlib.h>
+#include <string.h>
+#include <inttypes.h>
+#include "btstack.h"
+
+static const char hid_device_name[] = "Bluetooth Gamepad";
+static const char service_name[] = "Wireless Gamepad";
+static uint8_t hid_service_buffer[250];
+static uint8_t device_id_sdp_service_buffer[100];
+static btstack_packet_callback_registration_t hci_event_callback_registration;
+static uint16_t hid_cid;
+
+
+const uint8_t reportMap[] = {
+    0x05, 0x01,                   // USAGE_PAGE (Generic Desktop)
+    0x09, 0x05,                   // USAGE (Game Pad)
+    0xa1, 0x01,                   // COLLECTION (Application)
+    0xa1, 0x02,                   //    COLLECTION (Logical)
+    0x85, 0x30,                    //      REPORT_ID (48)
+
+    0x75, 0x08,                   //      REPORT_SIZE (8)
+    0x95, 0x02,                   //      REPORT_COUNT (2)
+    0x05, 0x01,                   //      USAGE_PAGE (Generic Desktop)
+    0x09, 0x30,                   //      USAGE (X)
+    0x09, 0x31,                   //      USAGE (Y)
+    0x15, 0x81,                   //      LOGICAL_MINIMUM (-127)
+    0x25, 0x7f,                   //      LOGICAL_MAXIMUM (127)
+    0x81, 0x02,                   //      INPUT (Data, Var, Abs)
+
+    0x75, 0x01,                   //      REPORT_SIZE (1)
+    0x95, 0x08,                   //      REPORT_COUNT (8)
+    0x15, 0x00,                   //      LOGICAL_MINIMUM (0)
+    0x25, 0x01,                   //      LOGICAL_MAXIMUM (1)
+    0x05, 0x09,                   //      USAGE_PAGE (Button)
+    0x19, 0x01,                   //      USAGE_MINIMUM (Button 1)
+    0x29, 0x08,                   //      USAGE_MAXIMUM (Button 8)
+    0x81, 0x02,                   //      INPUT (Data, Var, Abs)      
+    0xc0,                         //   END_COLLECTION
+    0xc0                          // END_COLLECTION
+  };
+typedef struct
+{
+  int8_t left_x;
+  int8_t left_y;
+  uint8_t buttons;
+}
+gamepad_report_t;
+
+static gamepad_report_t joystick;
+
+static void send_report_joystick(){
+    //Dummy report, presses two buttons and moves the stick to the down-right corner
+    joystick.left_x = 120;
+    joystick.left_y = 120;
+    joystick.buttons |= 0x1;
+    joystick.buttons |= 0x4;
+    uint8_t report[] = {0xa1, 0x30,joystick.left_x, joystick.left_y,joystick.buttons};  
+    //send report
+    hid_device_send_interrupt_message(hid_cid, &report[0], sizeof(report));
+}
+
+static void packet_handler(uint8_t packet_type, uint16_t channel, uint8_t * packet, uint16_t packet_size){
+    UNUSED(channel);
+    UNUSED(packet_size);
+    uint8_t status;
+     if(packet_type == HCI_EVENT_PACKET)
+    {
+        switch (packet[0]){
+            case BTSTACK_EVENT_STATE:
+                    if (btstack_event_state_get_state(packet) != HCI_STATE_WORKING) return;
+                    break;
+
+            case HCI_EVENT_USER_CONFIRMATION_REQUEST:
+                    // ssp: inform about user confirmation request
+                    log_info("SSP User Confirmation Request with numeric value '%06"PRIu32"'\n", hci_event_user_confirmation_request_get_numeric_value(packet));
+                    log_info("SSP User Confirmation Auto accept\n");
+                    break;
+            case HCI_EVENT_HID_META:
+                switch (hci_event_hid_meta_get_subevent_code(packet)){
+                    case HID_SUBEVENT_CONNECTION_OPENED:
+                        status = hid_subevent_connection_opened_get_status(packet);
+                        if (status) {
+                            // outgoing connection failed
+                            printf("Connection failed, status 0x%x\n", status);
+                            hid_cid = 0;
+                            return;
+                        }
+                        hid_cid = hid_subevent_connection_opened_get_hid_cid(packet);
+                        log_info("HID Connected\n");
+                        hid_device_request_can_send_now_event(hid_cid);
+                        break;
+                    case HID_SUBEVENT_CONNECTION_CLOSED:
+                        log_info("HID Disconnected\n");
+                        hid_cid = 0;
+                        break;
+                    case HID_SUBEVENT_CAN_SEND_NOW:  
+                        if(hid_cid!=0){ //Solves crash when disconnecting gamepad on android
+                          send_report_joystick();
+                          hid_device_request_can_send_now_event(hid_cid);
+                        }
+                        break;
+                    default:
+                        break;
+                }
+                break;
+            default:
+                break;
+        }
+    }
+}
+
+int btstack_main(int argc, const char * argv[]);
+int btstack_main(int argc, const char * argv[]){
+    (void)argc;
+    (void)argv;
+
+    gap_discoverable_control(1);
+    gap_set_class_of_device(0x2508);
+    gap_set_local_name(hid_device_name);
+
+    // L2CAP
+    l2cap_init();
+    // SDP Server
+    sdp_init();
+    memset(hid_service_buffer, 0, sizeof(hid_service_buffer));
+    hid_create_sdp_record(hid_service_buffer, 0x10000, 0x2508, 0, 0, 0, 0, reportMap, sizeof(reportMap), service_name);
+    sdp_register_service(hid_service_buffer);
+
+     // HID Device
+    hid_device_init(0, sizeof(reportMap), reportMap);
+
+    hci_event_callback_registration.callback = &packet_handler;
+    hci_add_event_handler(&hci_event_callback_registration);
+
+    hid_device_register_packet_handler(&packet_handler);
+
+    // turn on!
+    hci_power_control(HCI_POWER_ON);
+    return 0;
+}
+/* LISTING_END */
+/* EXAMPLE_END */