File content as of revision 2:02f3323a107d:

#ifndef MBED_MX12_H
#define MBED_MX12_H

/**  
* @file MX12.h  
* @brief this header file will contain all required  
*        definitions and basic utilities functions. 
* @details comming soon
*  
* @author Titouan Soulard 
* @author Bruno Denis (for comments)
* 
*/ 

#include "mbed.h"

#define MX12_ANSWER_MAX_SIZE 32
#define MX12_MOTOR_COUNT 16

/* Dynamixel protocol v1.0 : Instructions
 ******************************************/
#define PROTOCOL_INSTRUCTION_PING          0x01
#define PROTOCOL_INSTRUCTION_READ          0x02
#define PROTOCOL_INSTRUCTION_WRITE         0x03
#define PROTOCOL_INSTRUCTION_REG_WRITE     0x04
#define PROTOCOL_INSTRUCTION_ACTION        0x05
#define PROTOCOL_INSTRUCTION_FACTORY_RESET 0x06
#define PROTOCOL_INSTRUCTION_REBOOT        0x08
#define PROTOCOL_INSTRUCTION_SYNC_WRITE    0x83
#define PROTOCOL_INSTRUCTION_BULK_READ     0x92



/** 
 * @brief Class to communicate with Dynamixel MX12 servomotors. 
 *
 * @details
 *  The servomotors are daisy chained to a serial link of the target 
 *  microcontroller. The class ensures the initialization of serial link 
 *  and the management of communications. 
 *  Transmission of messages to the servomotors is blocking while 
 *  reception is non-blocking thanks to the use of an interrupt routine. 
 *  
 */
class MX12 
{
    public:
    
        /** Status enum, possible status of servomotor
         *
         */
        enum Status {
            InstructionError, ///< 
            OverloadError,
            ChecksumError,
            RangeError,
            OverheatingError,
            AngleLimitError,
            InputVoltageError,
            Unknown,
            Ok
        };
        
        /** State enum, possible state of communication automaton
         *
         */
         enum State {
            ReadingPosition,
            Writing,
            Available,
        };
    
        /** Create MX12 instance
         *
         * @param tx board pin used for transmission in UART daisy chain link 
         *           to servomotors 
         * @param rx board pin used for reception in UART daisy chain link 
         *           to servomotors 
         * @param baud modulation rate of UART signal, unit: Baud
         *           to servomotors 
         */
        MX12(PinName tx, PinName rx, int baud=115200);
        
        /** Send desired speed to a specifc servomotor
         *
         * @param mot_id a unique value in the daisy chain network to identify
         *               each servomotor
         * @param speed a float between -1 and 1 that represents the percentage
         *              of maximum requested speed
         */
        void SetSpeed(unsigned char mot_id, float speed);
        
        char IsAvailable(void);
        
        MX12::Status GetStatus(void);
        
        
        void ReadPosition(unsigned char mot_id);
        
        float GetPosition(unsigned char mot_id);
        
        void PrintAnswer();
        
        /**
         * Build and send an instruction packet to a servomotor according
         * DYNAMIXEL Protocol 1.0 (online protocol documentation 
         * https://emanual.robotis.com/docs/en/dxl/protocol1/)
         *
         * @param[in] mot_id indicates the ID of the device (servomotor) that
         *            should receive the Instruction Packet and process it
         * @param[in] address data address in the "Control Table of RAM Area"
         *            of a servomotor MX12 (https://emanual.robotis.com/docs/en/dxl/mx/mx-12w/#control-table-of-ram-area).
         * @param[in] len if it is a write instruction, size in bytes 
         *            of the data to write in the "Control Table of RAM Area"
         * @param[in] data array of char containing parameter of Danamixel  
         *            protocol that are the instruction’s auxiliary data field
         *  
         */
        void rw(unsigned char mot_id, char address, char len, char *data);
        
        /** Interupt Routine to read in data from UART daisy chain link
         *  (serial port)
         *
         */
        void _ReadCallback();
        
        char _chksm;
    
    private:
    
        UnbufferedSerial _mx12;
        MX12::Status _status;
        char _res[MX12_ANSWER_MAX_SIZE];
        char _res_count;
        char _len;
        MX12::State _state;
        float _angle[MX12_MOTOR_COUNT];
        int _baud;
};

#endif /* MBED_MX12_H */