/*
 *  test.c
 * 
 *  Created by Matthias Ringwald on 7/14/09.
 */

#include <unistd.h>
#include <stdio.h>
#include <stdlib.h>
#include <strings.h>

#include "../src/btstack.h"
#include "../src/run_loop.h"
#include "../src/hci.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

void data_handler(uint8_t *packet, uint16_t size){
	// just dump data for now
	hexdump( packet, size );
}

void event_handler(uint8_t *packet, uint16_t size){
    // bt stack activated, get started - set local name
    if (packet[0] == HCI_EVENT_BTSTACK_WORKING ||
	   (packet[0] == HCI_EVENT_BTSTACK_STATE && packet[2] == HCI_STATE_WORKING)) {
        bt_send_cmd(&hci_write_local_name, "BTstack-Test");
    }
    
	// use pairing yes/no
    if ( COMMAND_COMPLETE_EVENT(packet, hci_write_local_name) ) {
        bt_send_cmd(&hci_write_authentication_enable, 0);
    }
	
	// connect to HID device (PSM 0x13) at addr
    if ( COMMAND_COMPLETE_EVENT(packet, hci_write_authentication_enable) ) {
		bt_send_cmd(&l2cap_create_channel, addr, 0x13);
	}

	
	// inform about pin code request
	if (packet[0] == HCI_EVENT_PIN_CODE_REQUEST){
		printf("Please enter PIN 1234 on remote device\n");
	}
	
	// inform about new l2cap connection
	if (packet[0] == HCI_EVENT_L2CAP_CHANNEL_OPENED){
		bd_addr_t addr;
		bt_flip_addr(addr, &packet[2]);
		uint16_t psm = READ_BT_16(packet, 10); 
		uint16_t source_cid = READ_BT_16(packet, 12); 
		printf("Channel successfully opened: ");
		print_bd_addr(addr);
		printf(", handle 0x%02x, psm 0x%02x, source cid 0x%02x, dest cid 0x%02x\n",
			   READ_BT_16(packet, 8), psm, source_cid,  READ_BT_16(packet, 14));

		if (psm == 0x13) {
			// interupt channel openedn succesfully, now open control channel, too.
			bt_send_cmd(&l2cap_create_channel, addr, 0x11);
		} else {
			// request acceleration data.. probably has to be sent to control channel 0x11 instead of 0x13
			uint8_t setMode33[] = { 0x52, 0x12, 0x00, 0x33 };
			l2cap_send( source_cid, setMode33, sizeof(setMode33));
		}
	}
}


int main (int argc, const char * argv[]){
	bt_open();
	bt_register_event_packet_handler(event_handler);
	bt_register_data_packet_handler(data_handler);
	bt_send_cmd(&btstack_set_power_mode, HCI_POWER_ON );
	run_loop_execute();
	bt_close();
}