|
|
@ -142,7 +142,7 @@ void Subboard30ShakeModule::initialize() { |
|
|
|
|
|
|
|
{ |
|
|
|
// 飞特舵机总线
|
|
|
|
ZASSERT(huart3.Init.BaudRate == 1000000); |
|
|
|
ZASSERT(huart3.Init.BaudRate == 115200); |
|
|
|
feiteservomotor_bus.initialize(&huart3, hdma_usart3_rx, hdma_usart3_tx); |
|
|
|
} |
|
|
|
|
|
|
@ -152,6 +152,8 @@ void Subboard30ShakeModule::initialize() { |
|
|
|
int subid = 4; |
|
|
|
int subidInBus = 1; |
|
|
|
|
|
|
|
feiteservomotor_bus.regServo(subidInBus, feite::ksts5420m_c001); |
|
|
|
|
|
|
|
module.create_default_config(cfg); |
|
|
|
module.initialize(getmoduleId(subid), &feiteservomotor_bus, subidInBus, &cfg); |
|
|
|
GService::inst()->getZCanProtocolParser()->registerModule(&module); |
|
|
@ -163,6 +165,9 @@ void Subboard30ShakeModule::initialize() { |
|
|
|
int subid = 5; |
|
|
|
int subidInBus = 2; |
|
|
|
|
|
|
|
feiteservomotor_bus.regServo(subidInBus, feite::ksts5420m_c001); |
|
|
|
|
|
|
|
|
|
|
|
module.create_default_config(cfg); |
|
|
|
module.initialize(getmoduleId(subid), &feiteservomotor_bus, subidInBus, &cfg); |
|
|
|
GService::inst()->getZCanProtocolParser()->registerModule(&module); |
|
|
@ -174,6 +179,8 @@ void Subboard30ShakeModule::initialize() { |
|
|
|
int subid = 6; |
|
|
|
int subidInBus = 3; |
|
|
|
|
|
|
|
feiteservomotor_bus.regServo(subidInBus, feite::ksts5420m_c001); |
|
|
|
|
|
|
|
module.create_default_config(cfg); |
|
|
|
module.initialize(getmoduleId(subid), &feiteservomotor_bus, subidInBus, &cfg); |
|
|
|
GService::inst()->getZCanProtocolParser()->registerModule(&module); |
|
|
@ -185,6 +192,8 @@ void Subboard30ShakeModule::initialize() { |
|
|
|
int subid = 7; |
|
|
|
int subidInBus = 4; |
|
|
|
|
|
|
|
feiteservomotor_bus.regServo(subidInBus, feite::kscs009); |
|
|
|
|
|
|
|
module.create_default_config(cfg); |
|
|
|
module.initialize(getmoduleId(subid), &feiteservomotor_bus, subidInBus, &cfg); |
|
|
|
GService::inst()->getZCanProtocolParser()->registerModule(&module); |
|
|
|