Alvaro Cassinelli / Mbed 2 deprecated laserUI

Laser Sensing Display for UI interfaces in the real world

Dependencies:   mbed

Fork of skinGames_forktest by Alvaro Cassinelli

main.cpp@25:74cb85b85fd2, 2012-06-18 (annotated)

Committer:
mbedalvaro
Date:
Mon Jun 18 11:37:00 2012 +0000
Revision:
25:74cb85b85fd2
Parent:
24:4e52031a495b
Child:
27:1ce994629ffc
corrected some mistakes on color control;

Who changed what in which revision?

UserRevisionLine numberNew contents of line
mbedalvaro 0:345b3bc7a0ea 1 #include "mbed.h"
mbedalvaro 0:345b3bc7a0ea 2 #include "hardwareIO.h"
mbedalvaro 0:345b3bc7a0ea 3 #include "mbedOSC.h"
mbedalvaro 0:345b3bc7a0ea 4 #include "blobConfig.h"
mbedalvaro 0:345b3bc7a0ea 5 #include "simpleLaserRenderer.h"
mbedalvaro 0:345b3bc7a0ea 6
mbedalvaro 0:345b3bc7a0ea 7 extern "C" void mbed_reset();
mbedalvaro 0:345b3bc7a0ea 8
mbedalvaro 0:345b3bc7a0ea 9 blobConfig blobconf;
mbedalvaro 0:345b3bc7a0ea 10 simpleLaserSensingRenderer lsr;
mbedalvaro 0:345b3bc7a0ea 11
mbedalvaro 0:345b3bc7a0ea 12 // For tests:
mbedalvaro 0:345b3bc7a0ea 13 DigitalOut myled(LED1);
mbedalvaro 0:345b3bc7a0ea 14 DigitalOut myled2(LED2);
mbedalvaro 23:bf666fcc61bc 15 DigitalOut myled3(LED3);
mbedalvaro 0:345b3bc7a0ea 16
mbedalvaro 0:345b3bc7a0ea 17
mbedalvaro 1:a4050fee11f7 18 // To test the time it takes for executing one loop in the main program:
mbedalvaro 10:6f8e48dca1bd 19 //#define LOOPTIMECOMPUTE
mbedalvaro 1:a4050fee11f7 20
mbedalvaro 1:a4050fee11f7 21 // To get serial commands (for debug, or other things using a Terminal - for instance, a laser scan)
mbedalvaro 14:0fc33a3a7b4b 22 #define SERIAL_COMMANDS
mbedalvaro 0:345b3bc7a0ea 23
mbedalvaro 0:345b3bc7a0ea 24 //---------- ETHERNET / OSC related (in the future, put somewhere else...): -------------------------------------------
mbedalvaro 0:345b3bc7a0ea 25 // mbed IP address (server):
mbedalvaro 0:345b3bc7a0ea 26 #ifdef DHCP
mbedalvaro 0:345b3bc7a0ea 27 EthernetNetIf eth;
mbedalvaro 0:345b3bc7a0ea 28 #else
mbedalvaro 0:345b3bc7a0ea 29 EthernetNetIf eth(
mbedalvaro 1:a4050fee11f7 30 IpAddr(10,0,0,2), //IP Address
mbedalvaro 1:a4050fee11f7 31 IpAddr(255,255,255,0), //Network Mask
mbedalvaro 1:a4050fee11f7 32 IpAddr(10,0,0,1), //Gateway
mbedalvaro 1:a4050fee11f7 33 IpAddr(10,0,0,1) //DNS
mbedalvaro 0:345b3bc7a0ea 34 );
mbedalvaro 0:345b3bc7a0ea 35 #endif
mbedalvaro 0:345b3bc7a0ea 36
mbedalvaro 0:345b3bc7a0ea 37 //uint8_t serverMac[] = { 0xDE, 0xAD, 0xBE, 0xEF, 0xFE, 0xED };
mbedalvaro 0:345b3bc7a0ea 38 uint8_t serverIp[] = { 10, 0, 0, 2 }; // not needed perhaps!
mbedalvaro 0:345b3bc7a0ea 39 int serverPort = 10000;
mbedalvaro 1:a4050fee11f7 40
mbedalvaro 21:bc9b9383f4b6 41 uint8_t destIp[] = {10, 0, 0, 3};
mbedalvaro 0:345b3bc7a0ea 42 int destPort = 12000;
mbedalvaro 1:a4050fee11f7 43
mbedalvaro 0:345b3bc7a0ea 44 char *topAddress="/mbed";
mbedalvaro 0:345b3bc7a0ea 45 char *subAddress[3]={ "/test1" , "/test2" , "/test3" };
mbedalvaro 1:a4050fee11f7 46
mbedalvaro 0:345b3bc7a0ea 47 OSCMessage recMes;
mbedalvaro 0:345b3bc7a0ea 48 OSCMessage sendMes;
mbedalvaro 1:a4050fee11f7 49
mbedalvaro 1:a4050fee11f7 50 OSCClass osc;
mbedalvaro 1:a4050fee11f7 51 //OSCClass osc(&recMes); // instantiate OSC communication object, and set the receiver container from the OSC packets
mbedalvaro 1:a4050fee11f7 52
mbedalvaro 1:a4050fee11f7 53 void processOSC(UDPSocketEvent e);
mbedalvaro 0:345b3bc7a0ea 54 // ----------------------------------------------------------------------------------------------------------------------
mbedalvaro 0:345b3bc7a0ea 55
mbedalvaro 2:34157ebbf56b 56 // Tickers:
mbedalvaro 0:345b3bc7a0ea 57 Ticker timerForRendering;
mbedalvaro 2:34157ebbf56b 58 //Ticker timerForSendingData; // better use a timer, so as not to interrupt the exact laser display ticker
mbedalvaro 2:34157ebbf56b 59
mbedalvaro 9:3321170d157c 60 // Timers:
mbedalvaro 0:345b3bc7a0ea 61 Timer measureLoopPeriod;
mbedalvaro 9:3321170d157c 62 //Timer measureUpdatePeriod;
mbedalvaro 18:d72935b13858 63
mbedalvaro 0:345b3bc7a0ea 64
mbedalvaro 1:a4050fee11f7 65 // to get serial commands (not necessary perhaps)
mbedalvaro 0:345b3bc7a0ea 66 void processSerial();
mbedalvaro 1:a4050fee11f7 67
mbedalvaro 0:345b3bc7a0ea 68 int main() {
mbedalvaro 1:a4050fee11f7 69
mbedalvaro 0:345b3bc7a0ea 70 // Initialize the hardware (laser powers, positions...):
mbedalvaro 0:345b3bc7a0ea 71 IO.init();
mbedalvaro 0:345b3bc7a0ea 72
mbedalvaro 1:a4050fee11f7 73 // -------------------------------
mbedalvaro 1:a4050fee11f7 74 // Set the Ethernet port:
mbedalvaro 1:a4050fee11f7 75 printf("Setting up...\r\n");
mbedalvaro 1:a4050fee11f7 76 EthernetErr ethErr = eth.setup();
mbedalvaro 1:a4050fee11f7 77 if (ethErr) {
mbedalvaro 1:a4050fee11f7 78 printf("Error %d in setup.\r\n", ethErr);
mbedalvaro 1:a4050fee11f7 79 return -1;
mbedalvaro 1:a4050fee11f7 80 }
mbedalvaro 1:a4050fee11f7 81 printf("Setup OK\r\n");
mbedalvaro 1:a4050fee11f7 82
mbedalvaro 1:a4050fee11f7 83 //(1) Sending message:
mbedalvaro 1:a4050fee11f7 84 // Set IP and Port:
mbedalvaro 1:a4050fee11f7 85 sendMes.setIp( destIp );
mbedalvaro 1:a4050fee11f7 86 sendMes.setPort( destPort );
mbedalvaro 1:a4050fee11f7 87 // Set data:
mbedalvaro 1:a4050fee11f7 88 // sendMes.setTopAddress(topAddress);
mbedalvaro 1:a4050fee11f7 89
mbedalvaro 1:a4050fee11f7 90 //setting osc functionnality:
mbedalvaro 1:a4050fee11f7 91 //(2) Receiving:
mbedalvaro 1:a4050fee11f7 92 // recMes.setIp( serverIp ); // not needed?
mbedalvaro 1:a4050fee11f7 93 osc.setReceiveMessage(&recMes); // this sets the receiver container for the OSC packets (we can avoid doing this if we use osc.getMessage() to get messages)
mbedalvaro 1:a4050fee11f7 94 osc.begin(serverPort, &processOSC); // binds the upd (osc) messages to an arbitrary listening port ("server" port), and callback function
mbedalvaro 1:a4050fee11f7 95 // -------------------------------
mbedalvaro 1:a4050fee11f7 96
mbedalvaro 0:345b3bc7a0ea 97 /* // sending seems not to work right after setting the osc object??
mbedalvaro 0:345b3bc7a0ea 98 wait(1);
mbedalvaro 0:345b3bc7a0ea 99 sendMes.setTopAddress("starting");
mbedalvaro 1:a4050fee11f7 100 sendMes.setSubAddress("");
mbedalvaro 0:345b3bc7a0ea 101 osc.sendOsc( &sendMes );
mbedalvaro 0:345b3bc7a0ea 102 */
mbedalvaro 1:a4050fee11f7 103
mbedalvaro 0:345b3bc7a0ea 104 // initialize with the desired blob configuration:
mbedalvaro 1:a4050fee11f7 105
mbedalvaro 0:345b3bc7a0ea 106 // Tested modes:
mbedalvaro 1:a4050fee11f7 107 blobconf.clearConfig();
mbedalvaro 10:6f8e48dca1bd 108 // blobconf.addOneElasticLoopContractCentral();
mbedalvaro 11:62f7183a03e7 109 // blobconf.addOneElasticContourFollowing();
mbedalvaro 1:a4050fee11f7 110
mbedalvaro 14:0fc33a3a7b4b 111 // blobconf.addOneRigidLoopBouncing();
mbedalvaro 9:3321170d157c 112 // blobconf.addOneRigidLoopBouncing();
mbedalvaro 16:2ff1cb2ae1b1 113 //blobconf.addOneRigidLoopFollowing();
mbedalvaro 16:2ff1cb2ae1b1 114 blobconf.addOneRigidLoopFollowing();
mbedalvaro 2:34157ebbf56b 115
mbedalvaro 7:0df17f3078bc 116
mbedalvaro 5:73cd58b58f95 117 //blobconf.addOneRigidLoopTest();
mbedalvaro 1:a4050fee11f7 118
mbedalvaro 0:345b3bc7a0ea 119 // Important: first, set the initial position for all the blobs, this will be useful because
mbedalvaro 0:345b3bc7a0ea 120 // when changing modes we can use the previous central position...
mbedalvaro 1:a4050fee11f7 121 // blobconf.setInitialPos(CENTER_AD_MIRROR_X, CENTER_AD_MIRROR_Y);
mbedalvaro 1:a4050fee11f7 122
mbedalvaro 24:4e52031a495b 123 // draw the config once before activating the laser buffer:
mbedalvaro 5:73cd58b58f95 124 blobconf.draw();
mbedalvaro 13:9f03eac02700 125 lsr.startFullDisplay();
mbedalvaro 1:a4050fee11f7 126
mbedalvaro 0:345b3bc7a0ea 127 // RENRERER (attn: setConfigToRender must be called when the blobconf is set - i.e., the number of blobs and number of points/blob is fixed)
mbedalvaro 1:a4050fee11f7 128 lsr.setConfigToRender(&blobconf);
mbedalvaro 1:a4050fee11f7 129
mbedalvaro 1:a4050fee11f7 130 // Timer on the rendering function of the oneLoop object:
mbedalvaro 9:3321170d157c 131 // timerForRendering.attach(&lsr, &simpleLaserSensingRenderer::laserRenderThreadONEBLOBONLY, RENDER_INTERVAL); // the address of the object, member function, and interval (in seconds)
mbedalvaro 9:3321170d157c 132 timerForRendering.attach(&lsr, &simpleLaserSensingRenderer::laserRenderThread, RENDER_INTERVAL); // the address of the object, member function, and interval (in seconds)
mbedalvaro 1:a4050fee11f7 133
mbedalvaro 1:a4050fee11f7 134 // Timer for sending OSC data:
mbedalvaro 9:3321170d157c 135 // timerForSendingData.attach(&blobconf, &blobConfig::sendConfData, 0.025); // time in seconds (25ms -> 40Hz)
mbedalvaro 1:a4050fee11f7 136
mbedalvaro 1:a4050fee11f7 137 //========================================== INFINITE LOOP (in USER PROGRAM CONTEXT) ===================================================================
mbedalvaro 1:a4050fee11f7 138 #ifdef LOOPTIMECOMPUTE
mbedalvaro 1:a4050fee11f7 139 int timeCounterNum=1000;
mbedalvaro 1:a4050fee11f7 140 #endif
mbedalvaro 1:a4050fee11f7 141
mbedalvaro 9:3321170d157c 142 //measureUpdatePeriod.start();
mbedalvaro 1:a4050fee11f7 143
mbedalvaro 1:a4050fee11f7 144 while (true) {
mbedalvaro 1:a4050fee11f7 145
mbedalvaro 13:9f03eac02700 146 if (lsr.endedFullDisplay()) {
mbedalvaro 9:3321170d157c 147
mbedalvaro 9:3321170d157c 148 // measureUpdatePeriod.stop();
mbedalvaro 9:3321170d157c 149 // measureUpdatePeriod.reset();
mbedalvaro 9:3321170d157c 150
mbedalvaro 9:3321170d157c 151 // __disable_irq();
mbedalvaro 9:3321170d157c 152
mbedalvaro 1:a4050fee11f7 153 // update config dynamics (this also could be threaded?):
mbedalvaro 1:a4050fee11f7 154 blobconf.update();
mbedalvaro 1:a4050fee11f7 155
mbedalvaro 10:6f8e48dca1bd 156
mbedalvaro 1:a4050fee11f7 157 // draw the config (note: each kind of blob renders differently)
mbedalvaro 1:a4050fee11f7 158 blobconf.draw();
mbedalvaro 18:d72935b13858 159
mbedalvaro 18:d72935b13858 160
mbedalvaro 18:d72935b13858 161 // (b)Sending Data: // PUT THIS IN AN INTERRUPT OR USE A TIMER!!! it may be TOO FAST...
mbedalvaro 18:d72935b13858 162 // NOTE: better use a timer, so the only ISR "ticker" is the laser rendering (otherwise the laser rendering will be interrupted by the sending of data - the other way is ok):
mbedalvaro 18:d72935b13858 163 // NOTE: timer for sending is now not COMMON to all blobs, but depends on the blob (it could depend on the CONFIG only, but this can be simulated by using
mbedalvaro 18:d72935b13858 164 // per blob timer counter.
mbedalvaro 18:d72935b13858 165 blobconf.sendConfData();
mbedalvaro 18:d72935b13858 166
mbedalvaro 16:2ff1cb2ae1b1 167
mbedalvaro 23:bf666fcc61bc 168 lsr.startFullDisplay(); // this start the point-display counter (wherever the actual laser is). Before update and draw, the counter needs to be reset.
mbedalvaro 16:2ff1cb2ae1b1 169
mbedalvaro 9:3321170d157c 170
mbedalvaro 9:3321170d157c 171 // __enable_irq();
mbedalvaro 9:3321170d157c 172
mbedalvaro 9:3321170d157c 173 // measureUpdatePeriod.start();
mbedalvaro 10:6f8e48dca1bd 174
mbedalvaro 1:a4050fee11f7 175 }
mbedalvaro 0:345b3bc7a0ea 176
mbedalvaro 2:34157ebbf56b 177
mbedalvaro 1:a4050fee11f7 178 // COMMUNICATION:
mbedalvaro 1:a4050fee11f7 179 // (a) Reading commands:
mbedalvaro 1:a4050fee11f7 180 // Ethernet:
mbedalvaro 1:a4050fee11f7 181 Net::poll(); // this will take care of calling processOSC(UDPSocketEvent e) when a new packet arrives.
mbedalvaro 1:a4050fee11f7 182
mbedalvaro 1:a4050fee11f7 183 // Serial:
mbedalvaro 1:a4050fee11f7 184 #ifdef SERIAL_COMMANDS
mbedalvaro 1:a4050fee11f7 185 if (pc.readable()>0) processSerial();
mbedalvaro 1:a4050fee11f7 186 #endif
mbedalvaro 9:3321170d157c 187
mbedalvaro 9:3321170d157c 188
mbedalvaro 1:a4050fee11f7 189 // text:
mbedalvaro 1:a4050fee11f7 190 /*
mbedalvaro 1:a4050fee11f7 191 sendMes.setTopAddress("/hello");
mbedalvaro 1:a4050fee11f7 192 sendMes.setSubAddress("/daito"); // ATTENTION: the host computer needs to know in advance how many points are in the loop (I did not implement "bundle" messages yet...)
mbedalvaro 1:a4050fee11f7 193 int x=(long)10;
mbedalvaro 1:a4050fee11f7 194 sendMes.setArgs( "i", &x);
mbedalvaro 1:a4050fee11f7 195 osc.sendOsc( &sendMes );
mbedalvaro 1:a4050fee11f7 196 */
mbedalvaro 1:a4050fee11f7 197
mbedalvaro 0:345b3bc7a0ea 198 #ifdef LOOPTIMECOMPUTE
mbedalvaro 9:3321170d157c 199 if (timeCounterNum>50) myled = 0;
mbedalvaro 9:3321170d157c 200 // if (timeCounterNum%10==0) blobconf.sendConfData();
mbedalvaro 9:3321170d157c 201 if (timeCounterNum>100) {
mbedalvaro 1:a4050fee11f7 202 myled = 1;
mbedalvaro 1:a4050fee11f7 203 measureLoopPeriod.stop();
mbedalvaro 1:a4050fee11f7 204 sendMes.setTopAddress("/timeloop");
mbedalvaro 1:a4050fee11f7 205 sendMes.setSubAddress("/");
mbedalvaro 10:6f8e48dca1bd 206 // long x=(long)(int(measureLoopPeriod.read_us()/100.0));
mbedalvaro 9:3321170d157c 207 // long x=(long)(blobconf.blobArray[0]->displaySensingBuffer.lsdTrajectory.size());
mbedalvaro 9:3321170d157c 208 // long x=(long)(blobconf.blobArray[0]->normRecenteringVector);
mbedalvaro 10:6f8e48dca1bd 209 long x=(long)(1000*blobconf.blobArray[0]->displaySensingBuffer.lsdTrajectory[0].intensity);
mbedalvaro 1:a4050fee11f7 210 sendMes.setArgs( "i", &x);
mbedalvaro 1:a4050fee11f7 211 osc.sendOsc( &sendMes );
mbedalvaro 1:a4050fee11f7 212 timeCounterNum=0;
mbedalvaro 1:a4050fee11f7 213 measureLoopPeriod.reset();
mbedalvaro 1:a4050fee11f7 214 measureLoopPeriod.start();
mbedalvaro 1:a4050fee11f7 215 } else timeCounterNum++;
mbedalvaro 0:345b3bc7a0ea 216 #endif
mbedalvaro 0:345b3bc7a0ea 217
mbedalvaro 0:345b3bc7a0ea 218 }
mbedalvaro 0:345b3bc7a0ea 219 }
mbedalvaro 0:345b3bc7a0ea 220
mbedalvaro 1:a4050fee11f7 221 // ================= INTERPRET COMMAND =========================
mbedalvaro 0:345b3bc7a0ea 222 // NOTE: the following arrays are GLOBAL (used in processOSC and processSerial, as well as in interpretCommand function):
mbedalvaro 1:a4050fee11f7 223 // max of two addresses (top and sub), of a max length of 24 characters:
mbedalvaro 0:345b3bc7a0ea 224 char address[2][24];
mbedalvaro 0:345b3bc7a0ea 225 //long auxdata[2]; // to store a max of two arguments (note: we will only use LONGs)
mbedalvaro 1:a4050fee11f7 226 int data[2]; // this is to have -1 as NO DATA, to detect errors.
mbedalvaro 1:a4050fee11f7 227
mbedalvaro 1:a4050fee11f7 228 //interpretCommand(const char& address[2][], const int& data[2]) {
mbedalvaro 0:345b3bc7a0ea 229 void interpretCommand() {
mbedalvaro 0:345b3bc7a0ea 230 // (I) =========================================== SPECIAL FUNCTIONS (reset, rescan LUT, etc) ====================================================
mbedalvaro 16:2ff1cb2ae1b1 231 if ( !strcmp(address[0], "takeSnapshot" ) ) {
mbedalvaro 24:4e52031a495b 232 int value=data[0];
mbedalvaro 24:4e52031a495b 233 if (value!=-1) { // otherwise do nothing, this is a reception error (there was no data)
mbedalvaro 24:4e52031a495b 234
mbedalvaro 1:a4050fee11f7 235 // for test:
mbedalvaro 1:a4050fee11f7 236 for (int i=0; i<2 ; i++) {
mbedalvaro 1:a4050fee11f7 237 myled = 1;
mbedalvaro 1:a4050fee11f7 238 wait(0.1);
mbedalvaro 1:a4050fee11f7 239 myled = 0;
mbedalvaro 1:a4050fee11f7 240 wait(0.1);
mbedalvaro 1:a4050fee11f7 241 }
mbedalvaro 1:a4050fee11f7 242
mbedalvaro 1:a4050fee11f7 243 // First, we need to disable the threaded display for the loop:
mbedalvaro 1:a4050fee11f7 244 timerForRendering.detach();
mbedalvaro 1:a4050fee11f7 245
mbedalvaro 24:4e52031a495b 246 // Then, do the scan (sending values on SERIAL port):
mbedalvaro 24:4e52031a495b 247 IO.scan_serial(value);
mbedalvaro 1:a4050fee11f7 248
mbedalvaro 1:a4050fee11f7 249 // Finally, start again threaded display:
mbedalvaro 9:3321170d157c 250 timerForRendering.attach(&lsr, &simpleLaserSensingRenderer::laserRenderThread, RENDER_INTERVAL);
mbedalvaro 9:3321170d157c 251 // timerForRendering.attach(&lsr, &simpleLaserSensingRenderer::laserRenderThreadONEBLOBONLY, RENDER_INTERVAL);
mbedalvaro 24:4e52031a495b 252
mbedalvaro 24:4e52031a495b 253 }
mbedalvaro 1:a4050fee11f7 254 }
mbedalvaro 1:a4050fee11f7 255
mbedalvaro 1:a4050fee11f7 256 else if ( !strcmp(address[0], "mbedReset" ) ) mbed_reset();
mbedalvaro 22:d87317d7ca91 257
mbedalvaro 22:d87317d7ca91 258 else if (!strcmp(address[0], "showMirrorLimits")) {
mbedalvaro 22:d87317d7ca91 259 int value=data[0];
mbedalvaro 22:d87317d7ca91 260 if (value!=-1) { // otherwise do nothing, this is a reception error (there was no data)
mbedalvaro 22:d87317d7ca91 261 timerForRendering.detach();
mbedalvaro 24:4e52031a495b 262 IO.showLimitsMirrors(value);
mbedalvaro 22:d87317d7ca91 263 timerForRendering.attach(&lsr, &simpleLaserSensingRenderer::laserRenderThread, RENDER_INTERVAL);
mbedalvaro 24:4e52031a495b 264 }
mbedalvaro 22:d87317d7ca91 265 }
mbedalvaro 1:a4050fee11f7 266
mbedalvaro 1:a4050fee11f7 267 else if ( !strcmp(address[0], "calibrate" ) ) {
mbedalvaro 1:a4050fee11f7 268 // First, we need to disable the threaded display for the loop:
mbedalvaro 1:a4050fee11f7 269 timerForRendering.detach();
mbedalvaro 1:a4050fee11f7 270 // RESCAN (and save LUT table):
mbedalvaro 1:a4050fee11f7 271 IO.scanLUT();
mbedalvaro 1:a4050fee11f7 272 // Finally, start again threaded display:
mbedalvaro 9:3321170d157c 273 timerForRendering.attach(&lsr, &simpleLaserSensingRenderer::laserRenderThread, RENDER_INTERVAL);
mbedalvaro 9:3321170d157c 274 // timerForRendering.attach(&lsr, &simpleLaserSensingRenderer::laserRenderThreadONEBLOBONLY, RENDER_INTERVAL);
mbedalvaro 1:a4050fee11f7 275 }
mbedalvaro 1:a4050fee11f7 276
mbedalvaro 1:a4050fee11f7 277 // (II) ========================================= GLOBAL CONFIG and HARDWARE COMMANDS ===========================================
mbedalvaro 1:a4050fee11f7 278
mbedalvaro 1:a4050fee11f7 279 else if ( !strcmp(address[0], "setGreenLaser" ) ) {
mbedalvaro 1:a4050fee11f7 280 int value=data[0];
mbedalvaro 1:a4050fee11f7 281 if (value!=-1) { // otherwise do nothing, this is a reception error (there was no data)
mbedalvaro 25:74cb85b85fd2 282 if (value==0)
mbedalvaro 25:74cb85b85fd2 283 blobconf.allSetColor(0x04);// only red (note that we are in blue for "test" mode... so the blue will appear when touching something anyway
mbedalvaro 25:74cb85b85fd2 284 else
mbedalvaro 25:74cb85b85fd2 285 blobconf.allSetColor(0x06); // RED and GREEN (note: in the future, make a method to set colors properly! one by one...)
mbedalvaro 1:a4050fee11f7 286 }
mbedalvaro 1:a4050fee11f7 287 }
mbedalvaro 23:bf666fcc61bc 288
mbedalvaro 23:bf666fcc61bc 289 else if ( !strcmp(address[0], "testPower" ) ) {
mbedalvaro 23:bf666fcc61bc 290 // First, we need to disable the threaded display for the loop:
mbedalvaro 23:bf666fcc61bc 291 timerForRendering.detach();
mbedalvaro 23:bf666fcc61bc 292
mbedalvaro 23:bf666fcc61bc 293 // Note: arguments is first 3 bits to set the laser powers (3 LSB bits to set each color)
mbedalvaro 23:bf666fcc61bc 294 // and then the second argument is the number of seconds to wait for the measurment
mbedalvaro 23:bf666fcc61bc 295 int value1=data[0], value2=data[1];
mbedalvaro 23:bf666fcc61bc 296 if ((value1!=-1)&&(value2!=-1)) { // otherwise do nothing, this is a reception error (there was no data)
mbedalvaro 23:bf666fcc61bc 297
mbedalvaro 23:bf666fcc61bc 298 // Set position of mirrors:
mbedalvaro 23:bf666fcc61bc 299 IO.writeOutX(CENTER_AD_MIRROR_X);
mbedalvaro 23:bf666fcc61bc 300 IO.writeOutY(CENTER_AD_MIRROR_Y);
mbedalvaro 23:bf666fcc61bc 301
mbedalvaro 23:bf666fcc61bc 302 for (int i=0; i<3 ; i++) {
mbedalvaro 23:bf666fcc61bc 303 myled3 = 1;
mbedalvaro 23:bf666fcc61bc 304 wait(0.2);
mbedalvaro 23:bf666fcc61bc 305 myled3 = 0;
mbedalvaro 23:bf666fcc61bc 306 wait(0.2);
mbedalvaro 23:bf666fcc61bc 307 }
mbedalvaro 23:bf666fcc61bc 308
mbedalvaro 23:bf666fcc61bc 309 // Set laser power:
mbedalvaro 23:bf666fcc61bc 310 IO.setRGBPower((unsigned char)value1);
mbedalvaro 23:bf666fcc61bc 311
mbedalvaro 23:bf666fcc61bc 312 // Wait...
mbedalvaro 23:bf666fcc61bc 313 wait(value2);// in seconds
mbedalvaro 23:bf666fcc61bc 314 //Timer t;
mbedalvaro 23:bf666fcc61bc 315 //t.start();
mbedalvaro 23:bf666fcc61bc 316 //while(t.read_ms()<value2*1000);
mbedalvaro 23:bf666fcc61bc 317 //t.stop();
mbedalvaro 23:bf666fcc61bc 318 }
mbedalvaro 23:bf666fcc61bc 319
mbedalvaro 23:bf666fcc61bc 320 // Finally, start again threaded display:
mbedalvaro 23:bf666fcc61bc 321 timerForRendering.attach(&lsr, &simpleLaserSensingRenderer::laserRenderThread, RENDER_INTERVAL);
mbedalvaro 23:bf666fcc61bc 322
mbedalvaro 23:bf666fcc61bc 323 }
mbedalvaro 23:bf666fcc61bc 324
mbedalvaro 23:bf666fcc61bc 325
mbedalvaro 1:a4050fee11f7 326
mbedalvaro 1:a4050fee11f7 327 // SIMPLE BEHAVIOUR MODES (to be read from an XML file in the future):
mbedalvaro 11:62f7183a03e7 328 else if (!strcmp(address[0], "elastic_following")) { //
mbedalvaro 1:a4050fee11f7 329 timerForRendering.detach();
mbedalvaro 0:345b3bc7a0ea 330 // blobconf.computeBoundingBox();
mbedalvaro 1:a4050fee11f7 331 blobconf.clearConfig();
mbedalvaro 1:a4050fee11f7 332 blobconf.addOneElasticContourFollowing();
mbedalvaro 1:a4050fee11f7 333 lsr.setConfigToRender(&blobconf);
mbedalvaro 9:3321170d157c 334 timerForRendering.attach(&lsr, &simpleLaserSensingRenderer::laserRenderThread, RENDER_INTERVAL);
mbedalvaro 9:3321170d157c 335 // timerForRendering.attach(&lsr, &simpleLaserSensingRenderer::laserRenderThreadONEBLOBONLY, RENDER_INTERVAL);
mbedalvaro 16:2ff1cb2ae1b1 336
mbedalvaro 11:62f7183a03e7 337 } else if (!strcmp(address[0], "elastic_mouth")) { //
mbedalvaro 1:a4050fee11f7 338 timerForRendering.detach();
mbedalvaro 1:a4050fee11f7 339 // blobconf.computeBoundingBox();
mbedalvaro 1:a4050fee11f7 340 blobconf.clearConfig();
mbedalvaro 1:a4050fee11f7 341 blobconf.addOneElasticLoopContractCentral();
mbedalvaro 1:a4050fee11f7 342 lsr.setConfigToRender(&blobconf);
mbedalvaro 9:3321170d157c 343 timerForRendering.attach(&lsr, &simpleLaserSensingRenderer::laserRenderThread, RENDER_INTERVAL);
mbedalvaro 9:3321170d157c 344 // timerForRendering.attach(&lsr, &simpleLaserSensingRenderer::laserRenderThreadONEBLOBONLY, RENDER_INTERVAL);
mbedalvaro 19:228430f1350e 345
mbedalvaro 19:228430f1350e 346 } else if (!strcmp(address[0], "elastic_mouth_small")) { //
mbedalvaro 19:228430f1350e 347 timerForRendering.detach();
mbedalvaro 19:228430f1350e 348 // blobconf.computeBoundingBox();
mbedalvaro 19:228430f1350e 349 blobconf.clearConfig();
mbedalvaro 19:228430f1350e 350 blobconf.addOneElasticLoopContractCentralFast();
mbedalvaro 19:228430f1350e 351 lsr.setConfigToRender(&blobconf);
mbedalvaro 19:228430f1350e 352 timerForRendering.attach(&lsr, &simpleLaserSensingRenderer::laserRenderThread, RENDER_INTERVAL);
mbedalvaro 19:228430f1350e 353 // timerForRendering.attach(&lsr, &simpleLaserSensingRenderer::laserRenderThreadONEBLOBONLY, RENDER_INTERVAL);
mbedalvaro 1:a4050fee11f7 354 }
mbedalvaro 11:62f7183a03e7 355 else if (!strcmp(address[0], "spot_bouncing")) {
mbedalvaro 16:2ff1cb2ae1b1 356 int value=data[0];
mbedalvaro 16:2ff1cb2ae1b1 357 if (value!=-1) { // otherwise do nothing, this is a reception error (there was no data)
mbedalvaro 16:2ff1cb2ae1b1 358
mbedalvaro 16:2ff1cb2ae1b1 359 timerForRendering.detach();
mbedalvaro 16:2ff1cb2ae1b1 360 // blobconf.computeBoundingBox();
mbedalvaro 16:2ff1cb2ae1b1 361 blobconf.clearConfig();
mbedalvaro 16:2ff1cb2ae1b1 362
mbedalvaro 22:d87317d7ca91 363 // HACK for the time being:
mbedalvaro 24:4e52031a495b 364 /*
mbedalvaro 22:d87317d7ca91 365 int aux=rand()%100;
mbedalvaro 22:d87317d7ca91 366 if (aux<70) value=1;
mbedalvaro 22:d87317d7ca91 367 else if (aux<80) value=2;
mbedalvaro 22:d87317d7ca91 368 else value=3;
mbedalvaro 24:4e52031a495b 369 */
mbedalvaro 22:d87317d7ca91 370
mbedalvaro 16:2ff1cb2ae1b1 371 for (int i=0; i<value ; i++) blobconf.addOneRigidLoopBouncing();
mbedalvaro 16:2ff1cb2ae1b1 372
mbedalvaro 16:2ff1cb2ae1b1 373 lsr.setConfigToRender(&blobconf);
mbedalvaro 16:2ff1cb2ae1b1 374 timerForRendering.attach(&lsr, &simpleLaserSensingRenderer::laserRenderThread, RENDER_INTERVAL);
mbedalvaro 16:2ff1cb2ae1b1 375 // timerForRendering.attach(&lsr, &simpleLaserSensingRenderer::laserRenderThreadONEBLOBONLY, RENDER_INTERVAL);
mbedalvaro 16:2ff1cb2ae1b1 376 }
mbedalvaro 16:2ff1cb2ae1b1 377 }
mbedalvaro 16:2ff1cb2ae1b1 378
mbedalvaro 16:2ff1cb2ae1b1 379 else if (!strcmp(address[0], "spot_following")) {
mbedalvaro 16:2ff1cb2ae1b1 380 int value=data[0];
mbedalvaro 16:2ff1cb2ae1b1 381 if (value!=-1) { // otherwise do nothing, this is a reception error (there was no data)
mbedalvaro 16:2ff1cb2ae1b1 382
mbedalvaro 16:2ff1cb2ae1b1 383 timerForRendering.detach();
mbedalvaro 16:2ff1cb2ae1b1 384 // blobconf.computeBoundingBox();
mbedalvaro 16:2ff1cb2ae1b1 385 blobconf.clearConfig();
mbedalvaro 22:d87317d7ca91 386
mbedalvaro 22:d87317d7ca91 387 // HACK for the time being:
mbedalvaro 24:4e52031a495b 388 /*
mbedalvaro 22:d87317d7ca91 389 int aux=rand()%100;
mbedalvaro 22:d87317d7ca91 390 if (aux<70) value=1;
mbedalvaro 22:d87317d7ca91 391 else if (aux<80) value=2;
mbedalvaro 22:d87317d7ca91 392 else value=6;
mbedalvaro 24:4e52031a495b 393 */
mbedalvaro 22:d87317d7ca91 394
mbedalvaro 16:2ff1cb2ae1b1 395 for (int i=0; i<value ; i++) blobconf.addOneRigidLoopFollowing();
mbedalvaro 22:d87317d7ca91 396
mbedalvaro 22:d87317d7ca91 397
mbedalvaro 16:2ff1cb2ae1b1 398 lsr.setConfigToRender(&blobconf);
mbedalvaro 16:2ff1cb2ae1b1 399 timerForRendering.attach(&lsr, &simpleLaserSensingRenderer::laserRenderThread, RENDER_INTERVAL);
mbedalvaro 16:2ff1cb2ae1b1 400 // timerForRendering.attach(&lsr, &simpleLaserSensingRenderer::laserRenderThreadONEBLOBONLY, RENDER_INTERVAL);
mbedalvaro 16:2ff1cb2ae1b1 401 }
mbedalvaro 16:2ff1cb2ae1b1 402 }
mbedalvaro 16:2ff1cb2ae1b1 403
mbedalvaro 16:2ff1cb2ae1b1 404 else if (!strcmp(address[0], "spot_test")) {
mbedalvaro 0:345b3bc7a0ea 405 timerForRendering.detach();
mbedalvaro 0:345b3bc7a0ea 406 // blobconf.computeBoundingBox();
mbedalvaro 1:a4050fee11f7 407 blobconf.clearConfig();
mbedalvaro 16:2ff1cb2ae1b1 408 blobconf.addOneRigidLoopTest();
mbedalvaro 1:a4050fee11f7 409 lsr.setConfigToRender(&blobconf);
mbedalvaro 9:3321170d157c 410 timerForRendering.attach(&lsr, &simpleLaserSensingRenderer::laserRenderThread, RENDER_INTERVAL);
mbedalvaro 9:3321170d157c 411 // timerForRendering.attach(&lsr, &simpleLaserSensingRenderer::laserRenderThreadONEBLOBONLY, RENDER_INTERVAL);
mbedalvaro 1:a4050fee11f7 412 }
mbedalvaro 1:a4050fee11f7 413
mbedalvaro 1:a4050fee11f7 414 // other:
mbedalvaro 1:a4050fee11f7 415
mbedalvaro 24:4e52031a495b 416 else if ( !strcmp(address[0], "standby" ) ) { // will put ALL the blobs in stand by mode (no update function)
mbedalvaro 0:345b3bc7a0ea 417 blobconf.allStandBy(); // will avoid the update function
mbedalvaro 24:4e52031a495b 418 }
mbedalvaro 24:4e52031a495b 419 else if ( !strcmp(address[0], "resume" ) ) {
mbedalvaro 24:4e52031a495b 420 blobconf.allResume(); // Update function is called for all the blobs
mbedalvaro 1:a4050fee11f7 421 }
mbedalvaro 1:a4050fee11f7 422
mbedalvaro 1:a4050fee11f7 423 // (III) ========================================= Loop control (parameters, etc) ===========================================
mbedalvaro 19:228430f1350e 424
mbedalvaro 24:4e52031a495b 425 else if (!strcmp( address[0], "speedFactor" ) ) {
mbedalvaro 24:4e52031a495b 426 int value=data[0]; // value 100 means no change of speed. 200 is twice as fast, 50 is half as fast.
mbedalvaro 24:4e52031a495b 427 if (value!=-1) { // otherwise do nothing, this is a reception error (there was no data)
mbedalvaro 24:4e52031a495b 428 for (int i=0; i< blobconf.numBlobs; i++) {
mbedalvaro 24:4e52031a495b 429 //if ((!strcmp(blobconf.blobArray[i].spotName, "rigid_following"))||(!strcmp(blobconf.blobArray[i].spotName, "rigid_following"))) {
mbedalvaro 24:4e52031a495b 430 blobconf.blobArray[i]->speedFactor((float)(1.0*value/100.0));
mbedalvaro 24:4e52031a495b 431 }
mbedalvaro 24:4e52031a495b 432 }
mbedalvaro 24:4e52031a495b 433 }
mbedalvaro 24:4e52031a495b 434
mbedalvaro 24:4e52031a495b 435 else if (!strcmp( address[0], "adjustPlusAngle" ) ) {
mbedalvaro 24:4e52031a495b 436 int value=data[0]; // value 100 means no change of speed. 200 is twice as fast, 50 is half as fast.
mbedalvaro 24:4e52031a495b 437 if (value!=-1) { // otherwise do nothing, this is a reception error (there was no data)
mbedalvaro 24:4e52031a495b 438 for (int i=0; i< blobconf.numBlobs; i++) blobconf.blobArray[i]->displaySensingBuffer.addDelayMirrors(value);
mbedalvaro 24:4e52031a495b 439 }
mbedalvaro 24:4e52031a495b 440 }
mbedalvaro 24:4e52031a495b 441
mbedalvaro 24:4e52031a495b 442 else if (!strcmp( address[0], "adjustMinusAngle" ) ) {
mbedalvaro 24:4e52031a495b 443 int value=data[0]; // value 100 means no change of speed. 200 is twice as fast, 50 is half as fast.
mbedalvaro 24:4e52031a495b 444 if (value!=-1) { // otherwise do nothing, this is a reception error (there was no data)
mbedalvaro 24:4e52031a495b 445 for (int i=0; i< blobconf.numBlobs; i++) blobconf.blobArray[i]->displaySensingBuffer.addDelayMirrors(-value);
mbedalvaro 24:4e52031a495b 446 }
mbedalvaro 24:4e52031a495b 447 }
mbedalvaro 24:4e52031a495b 448
mbedalvaro 1:a4050fee11f7 449 else if (!strcmp( address[0], "sendOSC" ) ) {
mbedalvaro 1:a4050fee11f7 450 int value=data[0];
mbedalvaro 1:a4050fee11f7 451 if (value!=-1) { // otherwise do nothing, this is a reception error (there was no data)
mbedalvaro 1:a4050fee11f7 452 for (int i=0; i< blobconf.numBlobs; i++) {
mbedalvaro 1:a4050fee11f7 453 blobconf.blobArray[i]->sendOSC=(value>0);
mbedalvaro 1:a4050fee11f7 454 }
mbedalvaro 1:a4050fee11f7 455 }
mbedalvaro 1:a4050fee11f7 456 }
mbedalvaro 1:a4050fee11f7 457
mbedalvaro 1:a4050fee11f7 458 else if (!strcmp( address[0], "sendArea" ) ) {
mbedalvaro 1:a4050fee11f7 459 int value=data[0];
mbedalvaro 1:a4050fee11f7 460 if (value!=-1) { // otherwise do nothing, this is a reception error (there was no data)
mbedalvaro 1:a4050fee11f7 461 for (int i=0; i< blobconf.numBlobs; i++) {
mbedalvaro 1:a4050fee11f7 462 blobconf.blobArray[i]->sendingBlobArea=(value>0);
mbedalvaro 1:a4050fee11f7 463 }
mbedalvaro 1:a4050fee11f7 464 }
mbedalvaro 1:a4050fee11f7 465 }
mbedalvaro 1:a4050fee11f7 466
mbedalvaro 1:a4050fee11f7 467 else if (!strcmp( address[0], "sendPos" ) ) {
mbedalvaro 1:a4050fee11f7 468 int value=data[0];
mbedalvaro 1:a4050fee11f7 469 if (value!=-1) { // otherwise do nothing, this is a reception error (there was no data)
mbedalvaro 1:a4050fee11f7 470 for (int i=0; i< blobconf.numBlobs; i++) {
mbedalvaro 1:a4050fee11f7 471 blobconf.blobArray[i]->sendingLoopPositions=(value>0);
mbedalvaro 1:a4050fee11f7 472 }
mbedalvaro 1:a4050fee11f7 473 }
mbedalvaro 1:a4050fee11f7 474 }
mbedalvaro 1:a4050fee11f7 475
mbedalvaro 1:a4050fee11f7 476 else if (!strcmp( address[0], "sendRegions" ) ) {
mbedalvaro 1:a4050fee11f7 477 int value=data[0];
mbedalvaro 1:a4050fee11f7 478 if (value!=-1) { // otherwise do nothing, this is a reception error (there was no data)
mbedalvaro 1:a4050fee11f7 479 for (int i=0; i< blobconf.numBlobs; i++) {
mbedalvaro 1:a4050fee11f7 480 blobconf.blobArray[i]->sendingLoopRegions=(value>0);
mbedalvaro 1:a4050fee11f7 481 }
mbedalvaro 1:a4050fee11f7 482 }
mbedalvaro 1:a4050fee11f7 483 }
mbedalvaro 1:a4050fee11f7 484
mbedalvaro 1:a4050fee11f7 485 else if (!strcmp( address[0], "sendTouched" ) ) {
mbedalvaro 1:a4050fee11f7 486 int value=data[0];
mbedalvaro 1:a4050fee11f7 487 if (value!=-1) { // otherwise do nothing, this is a reception error (there was no data)
mbedalvaro 1:a4050fee11f7 488 for (int i=0; i< blobconf.numBlobs; i++) {
mbedalvaro 1:a4050fee11f7 489 blobconf.blobArray[i]->sendingTouched=(value>0);
mbedalvaro 1:a4050fee11f7 490 }
mbedalvaro 1:a4050fee11f7 491 }
mbedalvaro 1:a4050fee11f7 492 }
mbedalvaro 1:a4050fee11f7 493
mbedalvaro 1:a4050fee11f7 494
mbedalvaro 1:a4050fee11f7 495
mbedalvaro 0:345b3bc7a0ea 496 }
mbedalvaro 0:345b3bc7a0ea 497
mbedalvaro 0:345b3bc7a0ea 498 //============= RECEIVE OSC COMMANDS =========================
mbedalvaro 1:a4050fee11f7 499 // This is the callback function called when there are packets on the listening socket. It is not nice to have it
mbedalvaro 1:a4050fee11f7 500 // here, but for the time being having a "wrapping global" is the simplest solution (we cannot pass a member-function pointer
mbedalvaro 1:a4050fee11f7 501 // as handler to the upd object).
mbedalvaro 0:345b3bc7a0ea 502 void processOSC(UDPSocketEvent e) {
mbedalvaro 0:345b3bc7a0ea 503 osc.onUDPSocketEvent(e);
mbedalvaro 0:345b3bc7a0ea 504
mbedalvaro 0:345b3bc7a0ea 505 if (osc.newMessage) {
mbedalvaro 1:a4050fee11f7 506 // in fact, there is no need to check this if using the method of a global callback function - it is clear this is a new packet... however, it may be
mbedalvaro 1:a4050fee11f7 507 // interesting to use a timer, and process data (answers, etc) only after a certain amount of time, so as to avoid blocking the program in IRQ context...
mbedalvaro 1:a4050fee11f7 508
mbedalvaro 1:a4050fee11f7 509 // Acquire the addresses and arguments and put them in the GLOBAL variables:
mbedalvaro 1:a4050fee11f7 510 strcpy(address[0],"");
mbedalvaro 1:a4050fee11f7 511 strcpy(address[1],"");
mbedalvaro 1:a4050fee11f7 512 for (int i=0; i<recMes.getAddressNum(); i++) strcpy(address[i],recMes.getAddress(i)); // NOTE: up to the rest of the program to check if address[1] is really not null
mbedalvaro 1:a4050fee11f7 513 // Acquire data:
mbedalvaro 1:a4050fee11f7 514 data[0]=-1;
mbedalvaro 1:a4050fee11f7 515 data[1]=-1;
mbedalvaro 1:a4050fee11f7 516 for (int i=0; i<recMes.getArgNum(); i++) data[i]=(int)recMes.getArgInt(i);
mbedalvaro 1:a4050fee11f7 517
mbedalvaro 1:a4050fee11f7 518 // Finally, interpret the command:
mbedalvaro 1:a4050fee11f7 519 interpretCommand();//address, data);
mbedalvaro 1:a4050fee11f7 520
mbedalvaro 0:345b3bc7a0ea 521 }
mbedalvaro 1:a4050fee11f7 522 }
mbedalvaro 1:a4050fee11f7 523
mbedalvaro 0:345b3bc7a0ea 524 //============= RECEIVE SERIAL COMMANDS =========================
mbedalvaro 0:345b3bc7a0ea 525 //
mbedalvaro 1:a4050fee11f7 526 // NOTE: - NUMERIC PARAMETERS have to be send BEFORE the command word. They must be sent as ASCII DEC, without end character.
mbedalvaro 0:345b3bc7a0ea 527 // - Commands words SHOULD NOT have numbers in it. They should be C compliant STRINGS (ended with character '0')
mbedalvaro 1:a4050fee11f7 528 // - order is irrelevant: we can send 10 RADIUS or RADIUS 10.
mbedalvaro 0:345b3bc7a0ea 529
mbedalvaro 1:a4050fee11f7 530 // String to store ALPHANUMERIC DATA (i.e., integers, floating point numbers, unsigned ints, etc represented as DEC) sent wirelessly:
mbedalvaro 0:345b3bc7a0ea 531 char stringData[24]; // note: an integer is two bytes long, represented with a maximum of 5 digits, but we may send floats or unsigned int...
mbedalvaro 0:345b3bc7a0ea 532 int indexStringData=0;//position of the byte in the string
mbedalvaro 0:345b3bc7a0ea 533
mbedalvaro 0:345b3bc7a0ea 534 // String to store COMMAND WORDS:
mbedalvaro 0:345b3bc7a0ea 535 char stringCommand[24]; // note: an integer is two bytes long, represented with a maximum of 5 digits, but we may send floats or unsigned int...
mbedalvaro 0:345b3bc7a0ea 536 int indexStringCommand=0;
mbedalvaro 0:345b3bc7a0ea 537 bool commandReady=false; // will become true when receiving the byte 0 (i.e. the '/0' string terminator)
mbedalvaro 0:345b3bc7a0ea 538
mbedalvaro 0:345b3bc7a0ea 539 void processSerial() {
mbedalvaro 0:345b3bc7a0ea 540
mbedalvaro 1:a4050fee11f7 541 while (pc.readable()>0) {
mbedalvaro 1:a4050fee11f7 542
mbedalvaro 14:0fc33a3a7b4b 543
mbedalvaro 1:a4050fee11f7 544 char val =pc.getc();
mbedalvaro 0:345b3bc7a0ea 545 // pc.printf("Got :%d\n", incomingByte);
mbedalvaro 1:a4050fee11f7 546 //pc.putc(incomingByte);
mbedalvaro 1:a4050fee11f7 547
mbedalvaro 1:a4050fee11f7 548 // Save ASCII numeric characters (ASCII 0 - 9) on stringData:
mbedalvaro 1:a4050fee11f7 549 if ((val >= '0') && (val <= '9')) { // this is 45 to 57 (included)
mbedalvaro 1:a4050fee11f7 550 stringData[indexStringData] = val;
mbedalvaro 1:a4050fee11f7 551 indexStringData++;
mbedalvaro 1:a4050fee11f7 552 }
mbedalvaro 1:a4050fee11f7 553
mbedalvaro 1:a4050fee11f7 554 // Save ASCII letters in stringCommand:
mbedalvaro 1:a4050fee11f7 555 if ((val >= 'A') && (val <= 'z')) { // this is 65 to 122 (included)
mbedalvaro 1:a4050fee11f7 556 stringCommand[indexStringCommand] = val;
mbedalvaro 1:a4050fee11f7 557 indexStringCommand++;
mbedalvaro 1:a4050fee11f7 558 }
mbedalvaro 1:a4050fee11f7 559 // is command ready?
mbedalvaro 1:a4050fee11f7 560 if (val=='/') {
mbedalvaro 1:a4050fee11f7 561 commandReady=true;
mbedalvaro 1:a4050fee11f7 562 stringCommand[indexStringCommand] = 0; // string termination.
mbedalvaro 1:a4050fee11f7 563 indexStringCommand=0; // reset index string for acquiring next command
mbedalvaro 1:a4050fee11f7 564 //Serial.println(stringCommand);
mbedalvaro 1:a4050fee11f7 565 }
mbedalvaro 1:a4050fee11f7 566
mbedalvaro 1:a4050fee11f7 567 // COMMANDS (with or without numeric parameters):
mbedalvaro 1:a4050fee11f7 568 if (commandReady==true) { // it means we can interpret the command string:
mbedalvaro 1:a4050fee11f7 569 commandReady=false;
mbedalvaro 1:a4050fee11f7 570
mbedalvaro 1:a4050fee11f7 571 stringData[indexStringData] = 0 ;// string termination for numeric values;
mbedalvaro 1:a4050fee11f7 572 indexStringData=0;
mbedalvaro 1:a4050fee11f7 573
mbedalvaro 1:a4050fee11f7 574 // PARSE DATA: (TO DO!!!!!!!!!!!!!!):
mbedalvaro 0:345b3bc7a0ea 575
mbedalvaro 1:a4050fee11f7 576 // (a) Parse command (get address[0] and address[1]):
mbedalvaro 1:a4050fee11f7 577 //ex: "/1/standBy" -- > address[0]="1" and address[1]="standBy"
mbedalvaro 1:a4050fee11f7 578 // address[2]
mbedalvaro 1:a4050fee11f7 579
mbedalvaro 1:a4050fee11f7 580 // Serial.println(stringCommand);
mbedalvaro 1:a4050fee11f7 581 // Serial.println(stringData);
mbedalvaro 1:a4050fee11f7 582
mbedalvaro 1:a4050fee11f7 583 // (b) Parse data:
mbedalvaro 1:a4050fee11f7 584
mbedalvaro 1:a4050fee11f7 585 // char address[2][24];
mbedalvaro 1:a4050fee11f7 586 //long auxdata[2]; // to store a max of two arguments (note: we will only use LONGs)
mbedalvaro 1:a4050fee11f7 587 //int data[2]; // this is to have -1 as NO DATA, to detect errors.
mbedalvaro 1:a4050fee11f7 588
mbedalvaro 1:a4050fee11f7 589 // FOR THE TIME BEING there is no parsing for serial commands:
mbedalvaro 1:a4050fee11f7 590
mbedalvaro 1:a4050fee11f7 591 // SCANNING:
mbedalvaro 1:a4050fee11f7 592 if (!strcmp(stringCommand , "takeSnapshot")) {
mbedalvaro 1:a4050fee11f7 593 // First, we need to disable the threaded display for the loop:
mbedalvaro 1:a4050fee11f7 594 timerForRendering.detach();
mbedalvaro 1:a4050fee11f7 595
mbedalvaro 1:a4050fee11f7 596 // Then, do the scan (sending values on serial port):
mbedalvaro 24:4e52031a495b 597 IO.scan_serial(atoi(stringData));
mbedalvaro 1:a4050fee11f7 598
mbedalvaro 1:a4050fee11f7 599 // Finally, start again threaded display:
mbedalvaro 4:f9d364f10335 600 timerForRendering.attach(&lsr, &simpleLaserSensingRenderer::laserRenderThread, RENDER_INTERVAL);
mbedalvaro 9:3321170d157c 601 // timerForRendering.attach(&lsr, &simpleLaserSensingRenderer::laserRenderThreadONEBLOBONLY, RENDER_INTERVAL);
mbedalvaro 16:2ff1cb2ae1b1 602 } else if (!strcmp(stringCommand , "REDON")) IO.setRedPower(1); // pc.printf("%d\n",incomingByte);
mbedalvaro 1:a4050fee11f7 603
mbedalvaro 14:0fc33a3a7b4b 604 else if (!strcmp(stringCommand , "REDOFF")) IO.setRedPower(0);
mbedalvaro 14:0fc33a3a7b4b 605
mbedalvaro 14:0fc33a3a7b4b 606 else if (!strcmp(stringCommand , "READVALUE")) pc.printf("Value read: %f", lockin.getSmoothValue());//lockin.getLastValue());/
mbedalvaro 1:a4050fee11f7 607
mbedalvaro 14:0fc33a3a7b4b 608 else if (!strcmp(stringCommand , "mbedReset")) mbed_reset();
mbedalvaro 16:2ff1cb2ae1b1 609
mbedalvaro 14:0fc33a3a7b4b 610 else if (!strcmp(stringCommand , "calibrate")) {
mbedalvaro 16:2ff1cb2ae1b1 611 // First, we need to disable the threaded display for the loop:
mbedalvaro 16:2ff1cb2ae1b1 612 timerForRendering.detach();
mbedalvaro 16:2ff1cb2ae1b1 613 // RESCAN (and save LUT table):
mbedalvaro 16:2ff1cb2ae1b1 614 IO.scanLUT();
mbedalvaro 16:2ff1cb2ae1b1 615 // Finally, start again threaded display:
mbedalvaro 16:2ff1cb2ae1b1 616 timerForRendering.attach(&lsr, &simpleLaserSensingRenderer::laserRenderThread, RENDER_INTERVAL);
mbedalvaro 16:2ff1cb2ae1b1 617 // timerForRendering.attach(&lsr, &simpleLaserSensingRenderer::laserRenderThreadONEBLOBONLY, RENDER_INTERVAL);
mbedalvaro 16:2ff1cb2ae1b1 618 }
mbedalvaro 1:a4050fee11f7 619
mbedalvaro 1:a4050fee11f7 620 // FINALLY, interpret commands (but only after parsing):
mbedalvaro 1:a4050fee11f7 621 // interpretCommand();//address, data);
mbedalvaro 0:345b3bc7a0ea 622
mbedalvaro 0:345b3bc7a0ea 623 }
mbedalvaro 1:a4050fee11f7 624 }
mbedalvaro 1:a4050fee11f7 625 }
mbedalvaro 0:345b3bc7a0ea 626
mbedalvaro 0:345b3bc7a0ea 627
mbedalvaro 0:345b3bc7a0ea 628
mbedalvaro 0:345b3bc7a0ea 629 // ================ MISCELANEA
mbedalvaro 0:345b3bc7a0ea 630
mbedalvaro 0:345b3bc7a0ea 631 /* EXAMPLE SEND/RECEIVE on PROCESSING:
mbedalvaro 0:345b3bc7a0ea 632
mbedalvaro 0:345b3bc7a0ea 633 // oscP5sendreceive by andreas schlegel
mbedalvaro 0:345b3bc7a0ea 634 // example shows how to send and receive osc messages.
mbedalvaro 0:345b3bc7a0ea 635 // oscP5 website at http://www.sojamo.de/oscP5
mbedalvaro 0:345b3bc7a0ea 636
mbedalvaro 0:345b3bc7a0ea 637 import oscP5.*;
mbedalvaro 0:345b3bc7a0ea 638 import netP5.*;
mbedalvaro 1:a4050fee11f7 639
mbedalvaro 0:345b3bc7a0ea 640 OscP5 oscP5;
mbedalvaro 0:345b3bc7a0ea 641 NetAddress myRemoteLocation;
mbedalvaro 0:345b3bc7a0ea 642
mbedalvaro 0:345b3bc7a0ea 643 void setup() {
mbedalvaro 0:345b3bc7a0ea 644 size(400,400);
mbedalvaro 0:345b3bc7a0ea 645 frameRate(25);
mbedalvaro 1:a4050fee11f7 646 // start oscP5, listening for incoming messages at port 12000
mbedalvaro 0:345b3bc7a0ea 647 oscP5 = new OscP5(this,12000);
mbedalvaro 1:a4050fee11f7 648
mbedalvaro 0:345b3bc7a0ea 649 // myRemoteLocation is a NetAddress. a NetAddress takes 2 parameters,
mbedalvaro 0:345b3bc7a0ea 650 // an ip address and a port number. myRemoteLocation is used as parameter in
mbedalvaro 1:a4050fee11f7 651 // oscP5.send() when sending osc packets to another computer, device,
mbedalvaro 0:345b3bc7a0ea 652 // application. usage see below. for testing purposes the listening port
mbedalvaro 0:345b3bc7a0ea 653 // and the port of the remote location address are the same, hence you will
mbedalvaro 0:345b3bc7a0ea 654 // send messages back to this sketch.
mbedalvaro 0:345b3bc7a0ea 655 myRemoteLocation = new NetAddress("10.0.0.2",10000);
mbedalvaro 0:345b3bc7a0ea 656 }
mbedalvaro 0:345b3bc7a0ea 657
mbedalvaro 0:345b3bc7a0ea 658
mbedalvaro 0:345b3bc7a0ea 659 void draw() {
mbedalvaro 1:a4050fee11f7 660 background(0);
mbedalvaro 0:345b3bc7a0ea 661 }
mbedalvaro 0:345b3bc7a0ea 662
mbedalvaro 0:345b3bc7a0ea 663 void mousePressed() {
mbedalvaro 1:a4050fee11f7 664 // in the following different ways of creating osc messages are shown by example
mbedalvaro 0:345b3bc7a0ea 665 OscMessage myMessage = new OscMessage("/mbed/test1");
mbedalvaro 1:a4050fee11f7 666
mbedalvaro 1:a4050fee11f7 667 myMessage.add(123); // add an int to the osc message
mbedalvaro 0:345b3bc7a0ea 668
mbedalvaro 1:a4050fee11f7 669 // send the message
mbedalvaro 1:a4050fee11f7 670 oscP5.send(myMessage, myRemoteLocation);
mbedalvaro 0:345b3bc7a0ea 671 }
mbedalvaro 0:345b3bc7a0ea 672
mbedalvaro 0:345b3bc7a0ea 673
mbedalvaro 1:a4050fee11f7 674 // incoming osc message are forwarded to the oscEvent method.
mbedalvaro 0:345b3bc7a0ea 675 void oscEvent(OscMessage theOscMessage) {
mbedalvaro 1:a4050fee11f7 676 // print the address pattern and the typetag of the received OscMessage
mbedalvaro 0:345b3bc7a0ea 677 print("### received an osc message.");
mbedalvaro 0:345b3bc7a0ea 678 print(" addrpattern: "+theOscMessage.addrPattern());
mbedalvaro 0:345b3bc7a0ea 679 println(" typetag: "+theOscMessage.typetag());
mbedalvaro 0:345b3bc7a0ea 680 }
mbedalvaro 0:345b3bc7a0ea 681
mbedalvaro 0:345b3bc7a0ea 682 */