|
@ -42,77 +42,77 @@ static StepMotor45::cfg_t cfg1 = { |
|
|
.max_pos = -1, |
|
|
.max_pos = -1, |
|
|
.enable_zero_limit = false, |
|
|
.enable_zero_limit = false, |
|
|
.enable_max_pos_limit = false, |
|
|
.enable_max_pos_limit = false, |
|
|
.mirror = false, |
|
|
|
|
|
|
|
|
.mirror = true, |
|
|
|
|
|
|
|
|
.zeroPin = PinNull, |
|
|
.zeroPin = PinNull, |
|
|
.zeroPinMirror = false, |
|
|
.zeroPinMirror = false, |
|
|
|
|
|
|
|
|
.driverPin = {PB15, PD11, PD12, PD13}, |
|
|
.driverPin = {PB15, PD11, PD12, PD13}, |
|
|
.driverPinMirror = false, |
|
|
|
|
|
|
|
|
.driverPinMirror = true, |
|
|
}; |
|
|
}; |
|
|
|
|
|
|
|
|
static StepMotor45::cfg_t cfg2 = { |
|
|
static StepMotor45::cfg_t cfg2 = { |
|
|
.max_pos = -1, |
|
|
.max_pos = -1, |
|
|
.enable_zero_limit = false, |
|
|
.enable_zero_limit = false, |
|
|
.enable_max_pos_limit = false, |
|
|
.enable_max_pos_limit = false, |
|
|
.mirror = false, |
|
|
|
|
|
|
|
|
.mirror = true, |
|
|
|
|
|
|
|
|
.zeroPin = PinNull, |
|
|
.zeroPin = PinNull, |
|
|
.zeroPinMirror = false, |
|
|
.zeroPinMirror = false, |
|
|
|
|
|
|
|
|
.driverPin = {PG2, PG3, PG4, PG5}, |
|
|
.driverPin = {PG2, PG3, PG4, PG5}, |
|
|
.driverPinMirror = false, |
|
|
|
|
|
|
|
|
.driverPinMirror = true, |
|
|
}; |
|
|
}; |
|
|
|
|
|
|
|
|
static StepMotor45::cfg_t cfg3 = { |
|
|
static StepMotor45::cfg_t cfg3 = { |
|
|
.max_pos = -1, |
|
|
.max_pos = -1, |
|
|
.enable_zero_limit = false, |
|
|
.enable_zero_limit = false, |
|
|
.enable_max_pos_limit = false, |
|
|
.enable_max_pos_limit = false, |
|
|
.mirror = false, |
|
|
|
|
|
|
|
|
.mirror = true, |
|
|
|
|
|
|
|
|
.zeroPin = PinNull, |
|
|
.zeroPin = PinNull, |
|
|
.zeroPinMirror = false, |
|
|
.zeroPinMirror = false, |
|
|
|
|
|
|
|
|
.driverPin = {PG6, PG7, PG8, PC6}, |
|
|
.driverPin = {PG6, PG7, PG8, PC6}, |
|
|
.driverPinMirror = false, |
|
|
|
|
|
|
|
|
.driverPinMirror = true, |
|
|
}; |
|
|
}; |
|
|
|
|
|
|
|
|
static StepMotor45::cfg_t cfg4 = { |
|
|
static StepMotor45::cfg_t cfg4 = { |
|
|
.max_pos = -1, |
|
|
.max_pos = -1, |
|
|
.enable_zero_limit = false, |
|
|
.enable_zero_limit = false, |
|
|
.enable_max_pos_limit = false, |
|
|
.enable_max_pos_limit = false, |
|
|
.mirror = false, |
|
|
|
|
|
|
|
|
.mirror = true, |
|
|
|
|
|
|
|
|
.zeroPin = PinNull, |
|
|
.zeroPin = PinNull, |
|
|
.zeroPinMirror = false, |
|
|
.zeroPinMirror = false, |
|
|
|
|
|
|
|
|
.driverPin = {PC7, PC8, PC9, PA8}, |
|
|
|
|
|
.driverPinMirror = false, |
|
|
|
|
|
|
|
|
.driverPin = {PE0, PE2, PE4, PE6}, |
|
|
|
|
|
.driverPinMirror = true, |
|
|
}; |
|
|
}; |
|
|
|
|
|
|
|
|
static StepMotor45::cfg_t cfg5 = { |
|
|
static StepMotor45::cfg_t cfg5 = { |
|
|
.max_pos = -1, |
|
|
.max_pos = -1, |
|
|
.enable_zero_limit = false, |
|
|
.enable_zero_limit = false, |
|
|
.enable_max_pos_limit = false, |
|
|
.enable_max_pos_limit = false, |
|
|
.mirror = false, |
|
|
|
|
|
|
|
|
.mirror = true, |
|
|
|
|
|
|
|
|
.zeroPin = PinNull, |
|
|
.zeroPin = PinNull, |
|
|
.zeroPinMirror = false, |
|
|
.zeroPinMirror = false, |
|
|
|
|
|
|
|
|
.driverPin = {PA13, PA14, PA15, PC10}, |
|
|
|
|
|
.driverPinMirror = false, |
|
|
|
|
|
|
|
|
.driverPin = {PC13, PE5, PE3, PE1}, |
|
|
|
|
|
.driverPinMirror = true, |
|
|
}; |
|
|
}; |
|
|
static StepMotor45::cfg_t cfg6 = { |
|
|
static StepMotor45::cfg_t cfg6 = { |
|
|
.max_pos = -1, |
|
|
.max_pos = -1, |
|
|
.enable_zero_limit = false, |
|
|
.enable_zero_limit = false, |
|
|
.enable_max_pos_limit = false, |
|
|
.enable_max_pos_limit = false, |
|
|
.mirror = false, |
|
|
|
|
|
|
|
|
.mirror = true, |
|
|
|
|
|
|
|
|
.zeroPin = PinNull, |
|
|
.zeroPin = PinNull, |
|
|
.zeroPinMirror = false, |
|
|
.zeroPinMirror = false, |
|
|
|
|
|
|
|
|
.driverPin = {PC12, PD3, PD5, PD7}, |
|
|
.driverPin = {PC12, PD3, PD5, PD7}, |
|
|
.driverPinMirror = false, |
|
|
|
|
|
|
|
|
.driverPinMirror = true, |
|
|
}; |
|
|
}; |
|
|
|
|
|
|
|
|
map<int, float> screw_lead = { |
|
|
map<int, float> screw_lead = { |
|
@ -400,7 +400,7 @@ void Main::run() { |
|
|
g_step_motor[i++].initialize(15, 10000, &m_IflytopCanMaster); |
|
|
g_step_motor[i++].initialize(15, 10000, &m_IflytopCanMaster); |
|
|
g_step_motor[i++].initialize(16, 10000, &m_IflytopCanMaster); |
|
|
g_step_motor[i++].initialize(16, 10000, &m_IflytopCanMaster); |
|
|
|
|
|
|
|
|
// g_step_motor45[0].initialize(cfg1);
|
|
|
|
|
|
|
|
|
g_step_motor45[0].initialize(cfg1); |
|
|
g_step_motor45[1].initialize(cfg1); |
|
|
g_step_motor45[1].initialize(cfg1); |
|
|
g_step_motor45[2].initialize(cfg2); |
|
|
g_step_motor45[2].initialize(cfg2); |
|
|
g_step_motor45[3].initialize(cfg3); |
|
|
g_step_motor45[3].initialize(cfg3); |
|
|