Browse Source

tmc51x0添加id参数,方便打印

hand_acid_mainboard
zhaohe 11 months ago
parent
commit
d8826b58d6
  1. 10
      tmcdriver/tmc51x0/tmc51x0.cpp
  2. 4
      tmcdriver/tmc51x0/tmc51x0.hpp

10
tmcdriver/tmc51x0/tmc51x0.cpp

@ -42,7 +42,8 @@ static const uint8_t tmc5130_defaultRegisterAccess[TMC5130_REGISTER_COUNT] = {
#define TMC51x0_ADDRESS(x) ((x) & (TMC5130_ADDRESS_MASK))
#define TAG "TMC51X0"
void TMC51X0::initialize(TMC51X0Cfg cfg) {
void TMC51X0::initialize(int mid, TMC51X0Cfg cfg) {
m_mid = mid;
m_cfg = cfg;
m_hspi = cfg.hspi;
@ -211,6 +212,10 @@ void TMC51X0::moveToEnd(int32_t direction, uint32_t velocityMax) {
void TMC51X0::moveBy(int32_t relativePosition, uint32_t velocityMax) { // determine actual position and add numbers of ticks to move
zlock_guard lkg(m_mutex);
// m_mid
// ZLOGI(TAG, "m[%d] moveBy %d,%d", m_mid, relativePosition, velocityMax);
int32_t pos = getXACTUAL();
int32_t target = pos + relativePosition;
moveTo(target, velocityMax);
@ -370,9 +375,6 @@ bool TMC51X0::setEncResolution(int32_t enc_resolution) {
/**
* @brief
*
* 1.åè?¾çµæœºæ˜¯256ç»åˆ
* 2.åè?¾TMC5130_ENC_CONSTæ˜?åè¿åˆæ¨¡å¼?
* 3.å?æ?æŒæŒå®šåˆè¾¨çŽçšç¼ç å¨
*/
int32_t enc_resolution_tmp = enc_resolution * 4;

4
tmcdriver/tmc51x0/tmc51x0.hpp

@ -31,6 +31,7 @@ class TMC51X0 {
SPI_HandleTypeDef *m_hspi = NULL;
ZGPIO m_csnpin;
ZGPIO m_ennpin;
int m_mid = 0;
int32_t m_scale = 10000;
int32_t m_scale_deceleration = 1;
@ -42,10 +43,9 @@ class TMC51X0 {
bool m_driErr = false;
public:
void initialize(TMC51X0Cfg cfg);
void initialize(int mid, TMC51X0Cfg cfg);
private:
void readWriteArray(uint8_t *data, size_t length);
void writeDatagram(uint8_t address, uint8_t x1, uint8_t x2, uint8_t x3, uint8_t x4);
void writeInt(uint8_t address, int32_t value);

Loading…
Cancel
Save