|
|
@ -24,7 +24,11 @@ void MiniServoCtrlModule::initialize(uint16_t module_id, FeiTeServoMotor *bus, u |
|
|
|
m_bus->write_u8(m_idinbus, feite::kRegServoRunMode, feite::kServoMode); |
|
|
|
m_thread.init("MiniRobotCtrlModule", 1024, osPriorityNormal); |
|
|
|
} |
|
|
|
void MiniServoCtrlModule::create_default_config(config_t &cfg) {} |
|
|
|
void MiniServoCtrlModule::create_default_config(config_t &cfg) { |
|
|
|
cfg.limit_velocity = 10000; |
|
|
|
cfg.limit_torque = 300; |
|
|
|
cfg.protective_torque = 800; |
|
|
|
} |
|
|
|
|
|
|
|
int32_t MiniServoCtrlModule::getid(int32_t *id) { |
|
|
|
*id = m_module_id; |
|
|
|