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