diff --git a/src/bioloid_robot.cpp b/src/bioloid_robot.cpp
index 32524af4b30fda695134daf538c0fe9974ce40cc..d67e09fb94c3e60a08af9133f3d9a616e8594c36 100644
--- a/src/bioloid_robot.cpp
+++ b/src/bioloid_robot.cpp
@@ -49,7 +49,10 @@ CBioloidRobot::CBioloidRobot(const std::string &name,std::string &serial_dev,int
       this->robot_device->read_byte_register(BIOLOID_MM_NUM_SERVOS,&this->manager_num_servos);
       /* get the current action status */ 
       this->robot_device->read_byte_register(BIOLOID_ACTION_CNTRL,&this->action_status);
-      this->action_done=true;
+      if(this->action_status&ACTION_STATUS)
+        this->action_done=true;
+      else
+        this->action_done=false;
     }catch(CException &e){
       if(this->robot_device!=NULL)
         this->dyn_server->free_device(id);
diff --git a/src/examples/bioloid_robot_test.cpp b/src/examples/bioloid_robot_test.cpp
index 22c5c9d6a29f4262459fbe662b65392f6c180fb9..236f7f1175272af7c09ae4391e36bcc5563170d2 100644
--- a/src/examples/bioloid_robot_test.cpp
+++ b/src/examples/bioloid_robot_test.cpp
@@ -115,6 +115,7 @@ int main(int argc, char *argv[])
     tina.mm_disable_power();
     tina.mm_stop();*/
     std::cout << "Number of servos: " << (int)tina.mm_get_num_servos() << std::endl;
+    return 0;
     tina.action_disable_int();
     for(i=0;i<=MAX_NUM_SERVOS;i++)
     {