|
|
@ -209,8 +209,6 @@ int32_t TMC5130::readInt(uint8_t address) { |
|
|
|
|
|
|
|
return ((uint32_t)data[1] << 24) | ((uint32_t)data[2] << 16) | (data[3] << 8) | data[4]; |
|
|
|
} |
|
|
|
#endif
|
|
|
|
|
|
|
|
int32_t TMC5130::to_motor_acc(int32_t acc) { //
|
|
|
|
int32_t val = acc / 60.0 * 51200; |
|
|
|
return val; |
|
|
@ -231,4 +229,6 @@ int32_t TMC5130::to_user_pos(int32_t pos) { // |
|
|
|
int32_t TMC5130::to_user_vel(int32_t vel) { //
|
|
|
|
int32_t val = vel * 60.0 / 51200.0; |
|
|
|
return val; |
|
|
|
} |
|
|
|
} |
|
|
|
#endif
|
|
|
|
|