/Designs/ROBOTS/TEFO01A/SW/TEFO_motor_test.py
30,9 → 30,16
#spi.SPI_write_byte(self.CS, 0x15) # Full Step speed
#spi.SPI_write_byte(self.CS, 0x00)
#spi.SPI_write_byte(self.CS, 0x30)
#spi.SPI_write_byte(self.CS, 0x0A) # KVAL_RUN
#spi.SPI_write_byte(self.CS, 0x50)
spi.SPI_write_byte(self.CS, 0x18) # KVAL_RUN
spi.SPI_write_byte(self.CS, 0x09) # KVAL_HOLD
spi.SPI_write_byte(self.CS, 0xFF)
 
spi.SPI_write_byte(self.CS, 0x0A) # KVAL_RUN
spi.SPI_write_byte(self.CS, 0xFF)
 
spi.SPI_write_byte(self.CS, 0x0B) # KVAL_ACC
spi.SPI_write_byte(self.CS, 0xFF)
 
spi.SPI_write_byte(self.CS, 0x18) # Config register
spi.SPI_write_byte(self.CS, 0b11000000)
spi.SPI_write_byte(self.CS, 0x88)