From 2649fc1281157ffe6e72f6ecce5f5dc0d7e4456a Mon Sep 17 00:00:00 2001
From: Sergi Hernandez Juan <shernand@iri.upc.edu>
Date: Wed, 9 Jun 2021 18:09:43 +0200
Subject: [PATCH] Solved a bug: The current operational mode was not updated
 for extended register map servos.

---
 src/dynamixel_motor.cpp | 1 +
 1 file changed, 1 insertion(+)

diff --git a/src/dynamixel_motor.cpp b/src/dynamixel_motor.cpp
index 6648e98..aff4877 100644
--- a/src/dynamixel_motor.cpp
+++ b/src/dynamixel_motor.cpp
@@ -312,6 +312,7 @@ void CDynamixelMotor::set_control_mode(control_mode mode)
     {
       value=mode;
       this->write_register(this->registers[op_mode],value);
+      this->mode=mode;
     }
     else
     {
-- 
GitLab