File content as of revision 5:dae415fb4bad:

/*****************************************************
- Description: mbed to Dynamixel connection test using
    the library
- Requirements: 
    Dynamixel (i.e. DX116, RX28)
    MAX3088/MAX485 (RS485 transceiver)
- Connections:
    MAX3088     --  mbed
    ======================
    Pin 1       --  Pin 14
    Pin 2       --  Pin 15
    Pin 4       --  Pin 13
    
- Comments:
    See schematic for wiring details and class 
    documentation for available methods.
*****************************************************/

#include "mbed.h"
#include "Dynamixel.h"
#include "TextLCD.h"
#include "Uvtron.h"

// Defines
#define IR_CONST 1.229

// Settings                                         // Servo comm   : tx, rx, txEn, id, baud
TextLCD lcd(PA_5, PA_11, PA_6, PB_12, PA_7, PB_6);  // LCD          : rs, e, d4-d7
AnalogIn ir(PC_5);                                  // Sharp IR     : analog
DigitalOut m2(PA_15);                               // extinguisher : 12V out M2
DigitalOut m1(PB_7);                                // extinguisher : 12V out M1, possibly broken
DigitalOut led1(PC_13);                             // GPIO high is 3V3
DigitalOut led2(PC_14);
DigitalIn sound(PA_12);                              // Sound act    : digital, active low
DigitalIn uv(PB_8);                                 // UVTron       : digital, pin 2 = active low
Serial pc(USBTX, USBRX); // tx, rx


/* About interrupt
Where are the interrupt pins on NUCLEO-F411RE?

If you use a recent version of the mbed lib (right mouse button, update in the online compiler):
Every unique numbered pin. That means you can use any pin as InterruptIn, but you cannot use multiple
pins with the same number on a different port as InterruptIn. So you can use PA_1, PB_2, PA_3, PC_4, etc.
But in this example you could not use also PE_1. */

int main()
{   
    // Servos
    for (int i = 1; i <= 18; i++) {
        Dynamixel servo(PC_6, PC_7, PC_4, i, 1000000);
        servo.setSpeed(100);
        servo.move(512);        // Midddle, thus 90 deg position
    }
    
    float meas = 0;
    int snd = 0;
    int uvo = 0;
    
    while (1) {
        // LCD
        lcd.printf("%.2fcm\n", meas);
        pc.printf("%.2fcm ", meas);

        lcd.printf("s%d u%d\n", snd, uvo);
        pc.printf("s%d u%d\n", snd, uvo);
        
        // IR
        meas = ir.read(); // Converts and read the analog input value (value from 0.0 to 1.0)
        meas = ((1-meas)*26+4);
        
        // Extinguisher or 12V output
        m2 = 1;
        m1 = 1;
        
        // LED
        led1 = 1;
        led2 = 1;
        
        // Sound Activator
        snd = sound.read();
        
        // UV
        uvo = uv.read();
    }
}