|
|
|
|
@ -8,7 +8,8 @@
|
|
|
|
|
#include "uart_dmx.h"
|
|
|
|
|
|
|
|
|
|
stepper_T steppers[] = {
|
|
|
|
|
{.en_port=GPIOC, .en_pin=11, .dir_port=GPIOB, .dir_pin=4, .step_port=GPIOE, .step_pin=2, .home_port=GPIOF, .home_pin=3}
|
|
|
|
|
{.en_port=GPIOC, .en_pin=11, .dir_port=GPIOB, .dir_pin=4, .step_port=GPIOE, .step_pin=2, .home_port=GPIOF, .home_pin=3},
|
|
|
|
|
{.en_port=GPIOB, .en_pin=3, .dir_port=GPIOF, .dir_pin=11, .step_port=GPIOF, .step_pin=12, .home_port=GPIOF, .home_pin=4}
|
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
void set_pins(stepper_T* stp){
|
|
|
|
|
@ -127,7 +128,7 @@ void do_steps(){
|
|
|
|
|
if(steppers[i].homed){
|
|
|
|
|
static uint16_t old_ramp_to_speed;
|
|
|
|
|
old_ramp_to_speed = steppers[i].ramp_to_speed;
|
|
|
|
|
steppers[i].ramp_to_speed = rxBuffer[1] - steppers[i].pos;
|
|
|
|
|
steppers[i].ramp_to_speed = rxBuffer[i+1] - steppers[i].pos;
|
|
|
|
|
|
|
|
|
|
if(old_ramp_to_speed == 0 && steppers[i].ramp_to_speed != 0)
|
|
|
|
|
steppers[i].trigger_step = 1;
|
|
|
|
|
|