|
@ -21,7 +21,7 @@ using namespace iflytop; |
|
|
* IMPL * |
|
|
* IMPL * |
|
|
***********************************************************************************************************************/ |
|
|
***********************************************************************************************************************/ |
|
|
void Subboard10HbotV2::initialize() { |
|
|
void Subboard10HbotV2::initialize() { |
|
|
// IO_INIT();
|
|
|
|
|
|
|
|
|
IO_INIT(); |
|
|
GService::inst()->getZCanProtocolParser()->registerModule(this); |
|
|
GService::inst()->getZCanProtocolParser()->registerModule(this); |
|
|
|
|
|
|
|
|
// PB12
|
|
|
// PB12
|
|
@ -40,15 +40,12 @@ void Subboard10HbotV2::initialize() { |
|
|
TMC51X0_1_SD_MODE.initAsOutput(PB4, iflytop::ZGPIO::kMode_nopull, false, false); |
|
|
TMC51X0_1_SD_MODE.initAsOutput(PB4, iflytop::ZGPIO::kMode_nopull, false, false); |
|
|
TMC51X0_2_SPI_MODE.initAsOutput(PE11, iflytop::ZGPIO::kMode_nopull, false, true); |
|
|
TMC51X0_2_SPI_MODE.initAsOutput(PE11, iflytop::ZGPIO::kMode_nopull, false, true); |
|
|
TMC51X0_2_SD_MODE.initAsOutput(PE12, iflytop::ZGPIO::kMode_nopull, false, false); |
|
|
TMC51X0_2_SD_MODE.initAsOutput(PE12, iflytop::ZGPIO::kMode_nopull, false, false); |
|
|
|
|
|
|
|
|
|
|
|
osDelay(10); |
|
|
motorPowerEnPin.initAsOutput(PB12, iflytop::ZGPIO::kMode_nopull, true, true); |
|
|
motorPowerEnPin.initAsOutput(PB12, iflytop::ZGPIO::kMode_nopull, true, true); |
|
|
|
|
|
|
|
|
osDelay(100); |
|
|
|
|
|
|
|
|
|
|
|
TMC5130_MOTOR_INITER(/*motorid*/ 1, /*moduleid*/ 1); |
|
|
TMC5130_MOTOR_INITER(/*motorid*/ 1, /*moduleid*/ 1); |
|
|
TMC5130_MOTOR_INITER(/*motorid*/ 2, /*moduleid*/ 2); |
|
|
TMC5130_MOTOR_INITER(/*motorid*/ 2, /*moduleid*/ 2); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
#if 0
|
|
|
#if 0
|
|
|
/***********************************************************************************************************************
|
|
|
/***********************************************************************************************************************
|
|
|
* ID1 * |
|
|
* ID1 * |
|
|