mirror/btstack
1
0
Fork 0
mirror of https://github.com/bluekitchen/btstack.git synced 2025-03-26 11:37:10 +00:00
Code Issues Packages Projects Releases Wiki Activity

recommit wiimote code

Browse Source
This commit is contained in:
matthias.ringwald 2009-12-29 17:26:58 +00:00
parent b66fb894f8
commit b77060e279
1 changed files with 13 additions and 36 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

49
example/test.c
View File

@ -43,17 +43,12 @@
#include <btstack/btstack.h>
// bd_addr_t addr = {0x00, 0x03, 0xc9, 0x3d, 0x77, 0x43 }; // Think Outside Keyboard
// bd_addr_t addr = {0x00, 0x19, 0x1d, 0x90, 0x44, 0x68 }; // WiiMote
bd_addr_t addr = {0xd4, 0x9a, 0x20, 0x7e, 0x69, 0xcc }; // Magic Mouse
bd_addr_t addr = {0x00, 0x19, 0x1d, 0x90, 0x44, 0x68 }; // WiiMote
hci_con_handle_t con_handle;
uint16_t source_cid_interrupt;
uint16_t source_cid_control;
float xCoord = 0;
float yCoord = 0;
float speed = 0.2;
void packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){
bd_addr_t event_addr;
@ -62,27 +57,17 @@ void packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint
case L2CAP_DATA_PACKET:
// just dump data for now
// printf("source cid %x -- ", channel);
// hexdump( packet, size );
printf("source cid %x -- ", channel);
hexdump( packet, size );
// HOME => disconnect
if (packet[0] == 0xA1 && packet[1] == 0x10) {
int16_t moveX = READ_BT_16(packet, 3);
int16_t moveY = READ_BT_16(packet, 5);
xCoord+=moveX * speed;
yCoord+=moveY * speed;
xCoord = xCoord<0 ? 0:xCoord;
xCoord = xCoord>320 ? 320:xCoord;
yCoord = yCoord<0 ? 0:yCoord;
yCoord = yCoord>480 ? 480:yCoord;
printf("%3d %3d (delta %d %d) ", (int)xCoord, (int)yCoord, moveX, moveY);
if (packet[2] & 1) printf("Left ");
if (packet[2] & 2) printf("Right ");
printf("\n");
if (packet[0] == 0xA1) { // Status report
if (packet[1] == 0x30 || packet[1] == 0x31) { // type 0x30 or 0x31
if (packet[3] & 0x080) { // homne button pressed
printf("Disconnect baseband\n");
bt_send_cmd(&hci_disconnect, con_handle, 0x13); // remote closed connection
}
}
}
break;
@ -104,17 +89,9 @@ void packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint
case HCI_EVENT_PIN_CODE_REQUEST:
// inform about pin code request
printf("HCI_EVENT_PIN_CODE_REQUEST\n");
bt_flip_addr(event_addr, &packet[2]);
bt_send_cmd(&hci_pin_code_request_reply, event_addr, 4, "0000");
printf("Please enter PIN 1234 on remote device\n");
break;
case HCI_EVENT_LINK_KEY_REQUEST:
// link key request
bt_flip_addr(event_addr, &packet[2]);
bt_send_cmd(&hci_link_key_request_negative_reply, &event_addr);
break;
case L2CAP_EVENT_CHANNEL_OPENED:
// inform about new l2cap connection
// inform about new l2cap connection
@ -136,10 +113,10 @@ void packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint
source_cid_control = source_cid;
// request acceleration data..
uint8_t setMode31[] = { 0x52, 0x12, 0x00, 0x31 };
// bt_send_l2cap( source_cid, setMode31, sizeof(setMode31));
bt_send_l2cap( source_cid, setMode31, sizeof(setMode31));
// stop blinking
uint8_t setLEDs[] = { 0x52, 0x11, 0x10 };
// bt_send_l2cap( source_cid, setLEDs, sizeof(setLEDs));
bt_send_l2cap( source_cid, setLEDs, sizeof(setLEDs));
}
} else {
printf("L2CAP connection to device ");