| 0,0 → 1,133 |
|---|
| #include <stdio.h> |
| #include <stdlib.h> |
| #include <string.h> |
| #include <fcntl.h> |
| #include "lib/x52/x52.h" |
| |
| |
| |
| #include <unistd.h> |
| #include <sys/socket.h> |
| #include <bluetooth/bluetooth.h> |
| #include <bluetooth/hci.h> |
| #include <bluetooth/hci_lib.h> |
| |
| |
| |
| #include <linux/joystick.h> |
| #define JOY_DEV "/dev/input/js0" |
| |
| #define MAX_BT_DEVICES 3 |
| |
| int bt_device_count=0; |
| |
| char names[MAX_BT_DEVICES][248]; |
| char addrs[MAX_BT_DEVICES][19]; |
| |
| void scan_bt() |
| { |
| inquiry_info *ii = NULL; |
| |
| int dev_id, sock, len, flags; |
| int i; |
| char addr[19] = { 0 }; |
| char name[248] = { 0 }; |
| |
| dev_id = hci_get_route(NULL); |
| sock = hci_open_dev( dev_id ); |
| if (dev_id < 0 || sock < 0) { |
| perror("opening socket"); |
| exit(1); |
| } |
| |
| len = 8; |
| |
| flags = IREQ_CACHE_FLUSH; |
| ii = (inquiry_info*)malloc(MAX_BT_DEVICES * sizeof(inquiry_info)); |
| |
| bt_device_count = hci_inquiry(dev_id, len, MAX_BT_DEVICES, NULL, &ii, flags); |
| if( bt_device_count < 0 ) perror("hci_inquiry"); |
| |
| for (i = 0; i < bt_device_count; i++) { |
| ba2str(&(ii+i)->bdaddr, addr); |
| sprintf(addrs[i],"%s",addr); |
| |
| memset(name, 0, sizeof(name)); |
| |
| if (hci_read_remote_name(sock, &(ii+i)->bdaddr, sizeof(name), |
| name, 0) < 0) |
| sprintf(names[i],"[unknown]"); |
| else |
| sprintf(names[i],"%s",name); |
| |
| } |
| |
| |
| free( ii ); |
| close( sock ); |
| } |
| |
| |
| |
| |
| int main(int argc, char**argv) |
| { |
| int i; |
| |
| int x52_input_fd; |
| struct JS_DATA_TYPE x52_input_struct; |
| |
| |
| if( ( x52_input_fd = open( JOY_DEV, O_RDONLY ) ) < 0 ) |
| { |
| printf( "Couldn't open joystick device %s\n", JOY_DEV ); |
| return -1; |
| } |
| |
| |
| |
| printf("Initializing X-52 output .."); |
| struct x52 *x52_output = x52_init(); |
| if (x52_output) x52_settext(x52_output, 0 , "RIDDIM active", strlen("Scanning BT")); |
| if (x52_output) x52_setbri(x52_output, 1,128); |
| if (x52_output) |
| printf(" done \n"); |
| else |
| printf(" not found \n"); |
| |
| |
| printf("Scanning for Bluetooth Devices .."); |
| if (x52_output) x52_settext(x52_output, 1 , "Scanning BT", strlen("Scanning BT")); |
| // scan_bt(); |
| printf(" done \n"); |
| printf(" %d Devices found \n",bt_device_count); |
| for(i=0;i<bt_device_count;i++) |
| printf(" %d -> %s (%s) \n",i,names[i],addrs[i]); |
| printf("Starting UFO Control Seet ( ^c to quit ) \n"); |
| |
| |
| while( 1 ) |
| { |
| |
| if( read( x52_input_fd, &x52_input_struct, JS_RETURN ) != JS_RETURN ) |
| { |
| printf( "\nFailed to read from Joystick\n" ); |
| } |
| |
| if (x52_output) x52_setbri(x52_output, 0,x52_input_struct.x ); |
| if (x52_output) x52_setbri(x52_output, 1,x52_input_struct.y ); |
| if (x52_output) x52_setbri(x52_output, 2,x52_input_struct.x ); |
| |
| printf("X: % 4d Y: % 4d Z: % 4d B1: %1d B2: %1d \r" |
| ,x52_input_struct.x /* X axis */ |
| ,x52_input_struct.y /* Y axis */ |
| ,x52_input_struct.y /* Z axis */ |
| ,(x52_input_struct.buttons & 1) ? 1 : 0 /* button 1 */ |
| ,(x52_input_struct.buttons & 2) ? 1 : 0 ); /* button 2 */ |
| } |
| |
| close(x52_input_fd); /* too bad we never get here */ |
| |
| if (x52_output) x52_close(x52_output); |
| return 0; |
| } |