Added a function to get the register address for each model.

include/dynamixel_motor.h

@@ -480,6 +480,11 @@ class CDynamixelMotor
      *
      */
     void get_drive_mode(bool &time_based,bool &reverse);
+    /**
+     * \ brief
+     *
+     */
+    unsigned short int get_register_address(reg_id id);
     /**
      * \brief 
      *  

src/dynamixel_motor.cpp

@@ -1404,6 +1404,11 @@ void CDynamixelMotor::get_drive_mode(bool &time_based,bool &reverse)
   }
 }
 
+unsigned short int CDynamixelMotor::get_register_address(reg_id id)
+{
+  return this->registers[id].address;
+}
+
 CDynamixelMotor::~CDynamixelMotor()
 {
   /* stop the motor */

src/dynamixel_registers.cpp

@@ -418,4 +418,4 @@ TDynReg mx_28_2_0_reg[NUM_REG]={// Info
                          {0x007C,2,false},
                          {0x0078,2,false},
                          {0x0088,5,false},
-                         {0x008C,4,false}};
+                         {0x008C,4,false}};
\ No newline at end of file