|
|
@ -173,35 +173,40 @@ static void initsubmodule() { |
|
|
|
{ |
|
|
|
static MiniRobotCtrlModule mini_servo; |
|
|
|
static MiniRobotCtrlModule::flash_config_t cfg = {0}; |
|
|
|
cfg.default_torque = 330; |
|
|
|
cfg.default_torque = 300; |
|
|
|
cfg.default_velocity = 200; |
|
|
|
mini_servo.initialize(initer.get_module_id(1), &feiteservomotor_bus, 1, &cfg); |
|
|
|
initer.register_module(&mini_servo); |
|
|
|
} |
|
|
|
{ |
|
|
|
static MiniRobotCtrlModule mini_servo; |
|
|
|
static MiniRobotCtrlModule::flash_config_t cfg = {0}; |
|
|
|
cfg.default_torque = 330; |
|
|
|
cfg.default_torque = 300; |
|
|
|
cfg.default_velocity = 200; |
|
|
|
mini_servo.initialize(initer.get_module_id(2), &feiteservomotor_bus, 2, &cfg); |
|
|
|
initer.register_module(&mini_servo); |
|
|
|
} |
|
|
|
{ |
|
|
|
static MiniRobotCtrlModule mini_servo; |
|
|
|
static MiniRobotCtrlModule::flash_config_t cfg = {0}; |
|
|
|
cfg.default_torque = 330; |
|
|
|
cfg.default_torque = 300; |
|
|
|
cfg.default_velocity = 200; |
|
|
|
mini_servo.initialize(initer.get_module_id(3), &feiteservomotor_bus, 3, &cfg); |
|
|
|
initer.register_module(&mini_servo); |
|
|
|
} |
|
|
|
{ |
|
|
|
static MiniRobotCtrlModule mini_servo; |
|
|
|
static MiniRobotCtrlModule::flash_config_t cfg = {0}; |
|
|
|
cfg.default_torque = 330; |
|
|
|
cfg.default_torque = 300; |
|
|
|
cfg.default_velocity = 200; |
|
|
|
mini_servo.initialize(initer.get_module_id(4), &feiteservomotor_bus, 4, &cfg); |
|
|
|
initer.register_module(&mini_servo); |
|
|
|
} |
|
|
|
{ |
|
|
|
static MiniRobotCtrlModule mini_servo; |
|
|
|
static MiniRobotCtrlModule::flash_config_t cfg = {0}; |
|
|
|
cfg.default_torque = 330; |
|
|
|
cfg.default_torque = 300; |
|
|
|
cfg.default_velocity = 200; |
|
|
|
mini_servo.initialize(initer.get_module_id(5), &feiteservomotor_bus, 5, &cfg); |
|
|
|
initer.register_module(&mini_servo); |
|
|
|
} |
|
|
|