Changed the address of the sync write function.

src/bioloid_stm32.c

@@ -27,7 +27,7 @@ int32_t main(void)
   bioloid_time_init();
   /* initialize zigbee module */
   zigbee_init();
-//  zigbee_enable_power();
+  zigbee_enable_power();
   /* initialize the dynamixel slave interface */
   bioloid_dyn_slave_init();
   bioloid_dyn_slave_start();

src/motion_manager.c

@@ -44,7 +44,7 @@ void manager_send_motion_command(void)
     }
   }
   if(num>0)
-    dyn_master_sync_write(&bioloid_dyn_master_servos,num,servo_ids,P_GOAL_POSITION_L,4,write_data);
+    dyn_master_sync_write(&bioloid_dyn_master_servos,num,servo_ids,P_CW_COMPLIANCE_SLOPE,4,write_data);
 }
 
 inline uint16_t manager_angle_to_value(uint8_t servo_id,int16_t angle)