![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
Testing 6DOF USB HID joystick device.
Dependencies: USBDevice USBJoystick mbed
Diff: main.cpp
- Revision:
- 2:e9926793544d
- Parent:
- 1:346022f10041
- Child:
- 3:9b51b991e5d6
--- a/main.cpp Fri Jan 13 07:11:30 2017 +0000 +++ b/main.cpp Fri Jan 13 07:48:38 2017 +0000 @@ -2,7 +2,7 @@ * 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 + * 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 @@ -33,9 +33,9 @@ // Variables for Heartbeat and Status monitoring PwmOut myled1(LED1); -PwmOut myled2(LED2); -PwmOut myled3(LED3); -PwmOut heartbeatLED(LED4); +//PwmOut myled2(LED2); +//PwmOut myled3(LED3); +//DigitalOut heartbeatLED(LED4); AnalogIn joyXin(A0); AnalogIn joyYin(A1); @@ -49,81 +49,92 @@ int16_t map(int32_t x, int32_t in_min, int32_t in_max, int32_t out_min, int32_t out_max) // found here: C:\Program Files (x86)\Arduino\hardware\arduino\avr\cores\arduino\WMath.cpp { - return (int16_t)((x - in_min) * (out_max - out_min) / (in_max - in_min) + out_min); + return (int16_t)((x - in_min) * (out_max - out_min) / (in_max - in_min) + out_min); } -float mapf(float x, float in_min, float in_max, float out_min, float out_max) { +float mapf(float x, float in_min, float in_max, float out_min, float out_max) +{ return (x - in_min) * (out_max - out_min) / (in_max - in_min) + out_min; } // Heartbeat monitor -//void pulse() { -// heartbeatLED = !heartbeatLED; +//void pulse() +//{ +// heartbeatLED = !heartbeatLED; //} // -//void heartbeat_start() { -// heartbeatLED=1; -// heartbeat.attach(&pulse, 0.5); +//void heartbeat_start() +//{ +// heartbeatLED = 1; +// heartbeat.attach(&pulse, 0.5); //} // -//void heartbeat_stop() { -// heartbeat.detach(); +//void heartbeat_stop() +//{ +// heartbeat.detach(); //} -int main() { - uint16_t i = 0; - int16_t x = 0; - int16_t y = 0; - int16_t z = 0; - int16_t rx = 0; - int16_t ry = 0; - int16_t rz = 0; - uint8_t tmp = 0; - uint32_t buttons = 0; - uint8_t hat = 0; - - pc.printf("Hello World from Joystick!\n\r"); +int main() +{ + uint16_t i = 0; + int16_t x = 0; + int16_t y = 0; + int16_t z = 0; + int16_t rx = 0; + int16_t ry = 0; + int16_t rz = 0; + uint8_t tmp = 0; + uint32_t buttons = 0; + uint8_t hat = 0; + pc.printf("6 DOF Joystick\n\r"); + +// myled1 = 0; +// myled2 = 0; +// myled3 = 0; +// heartbeatLED = 0; // heartbeat_start(); - while (1) { - // 6DOF Joystick with buttons and a hat + while (1) { + // 6DOF Joystick with buttons and a hat #if (BUTTONS4 == 1) - buttons = (i >> 8) & 0x0F; // value 0 .. 15, one bit per button + buttons = (i >> 8) & 0x0F; // value 0 .. 15, one bit per button #endif #if (BUTTONS8 == 1) - buttons = (i >> 8) & 0xFF; // value 0 .. 255, one bit per button + buttons = (i >> 8) & 0xFF; // value 0 .. 255, one bit per button #endif #if (BUTTONS32 == 1) - tmp = (i >> 8) & 0xFF; // value 0 .. 255, one bit per button - buttons = (( tmp << 0) & 0x000000FF); - buttons = buttons | ((~tmp << 8) & 0x0000FF00); - buttons = buttons | (( tmp << 16) & 0x00FF0000); - buttons = buttons | ((~tmp << 24) & 0xFF000000); + tmp = (i >> 8) & 0xFF; // value 0 .. 255, one bit per button + buttons = (( tmp << 0) & 0x000000FF); + buttons = buttons | ((~tmp << 8) & 0x0000FF00); + buttons = buttons | (( tmp << 16) & 0x00FF0000); + buttons = buttons | ((~tmp << 24) & 0xFF000000); #endif #if (HAT4 == 1) - hat = (i >> 8) & 0x03; // value 0, 1, 2, 3 or 4 for neutral + hat = (i >> 8) & 0x03; // value 0, 1, 2, 3 or 4 for neutral #endif #if (HAT8 == 1) - hat = (i >> 8) & 0x07; // value 0..7 or 8 for neutral + hat = (i >> 8) & 0x07; // value 0..7 or 8 for neutral #endif - i++; - + i++; + // joystick.move(joyXin, joyYin, joyZin, joyRxin, joyRyin, joyRzin); - x = map(joyXin.read_u16(), 0, 65535, -32768, 32768); // value -32768 .. 32767 - y = map(joyYin.read_u16(), 0, 65535, -32768, 32768); - z = map(joyZin.read_u16(), 0, 65535, -32768, 32768); - rx = map(joyRxin.read_u16(), 0, 65535, -32768, 32768); - ry = map(joyRyin.read_u16(), 0, 65535, -32768, 32768); - rz = map(joyRzin.read_u16(), 0, 65535, -32768, 32768); - - myled1 = mapf(x, -32768, 32768, 0, 1.0); - - joystick.update(x, y, z, rx, ry, rz, buttons, hat); - wait(0.005); - } + x = map(joyXin.read_u16(), 0, 65535, -32768, 32768); // value -32768 .. 32767 + y = map(joyYin.read_u16(), 0, 65535, -32768, 32768); + z = map(joyZin.read_u16(), 0, 65535, -32768, 32768); + rx = map(joyRxin.read_u16(), 0, 65535, -32768, 32768); + ry = map(joyRyin.read_u16(), 0, 65535, -32768, 32768); + rz = map(joyRzin.read_u16(), 0, 65535, -32768, 32768); + + myled1 = mapf(x, -32768, 32768, 0, 1.0); + + pc.printf(" %d %d %d %d %d %d\r\n", x, y, z, rx, ry, rz); + + joystick.update(x, y, z, rx, ry, rz, buttons, hat); + wait(0.005); + } } \ No newline at end of file