Tool/software:
{
int32_t t_count2;
int32_t res1;
res1 = res;
t_count2 = (f_cpu/(res1*2*1));
t_count2 = (t_count2 - posone);
ICR4 = (int16_t)t_count2;//22
TCCR4A = 0x10; //**Toggle OC4B on ctc*/
TCCR4B = 0x19; /**WGM=toggle,mode ctc, NO PRESCALER**/
// TIMSK4 = 0x02;
}
{
uint8_t dataHi = 0;
uint8_t dataLo = 0;
/**Write CTRL Register **/
dataHi = 0x00;
dataLo = 0x39;//0X39;
SPI_DRV8711_ReadWrite(dataHi, dataLo);
/**Write TORQUE Register **/
dataHi = 0x16;
dataLo = 0x39;//0x36;//0x20;// 0x30; //0x58
driver_stat = dataLo;
SPI_DRV8711_ReadWrite(dataHi, dataLo);
/**Write OFF Register **/
dataHi = 0x20;
dataLo = 0x28;
SPI_DRV8711_ReadWrite(dataHi, dataLo);
/**Write BLANK Register**/
dataHi = 0x30;
dataLo = 0x00;
SPI_DRV8711_ReadWrite(dataHi, dataLo);
/**Write DECAY Register**/
dataHi = 0x41;
dataLo = 0x0F;
SPI_DRV8711_ReadWrite(dataHi, dataLo);
/**Write STALL Register**/
dataHi = 0x5F;//0x5C;//0x50;
dataLo = 0xFF;
SPI_DRV8711_ReadWrite(dataHi, dataLo);
/**Write DRIVE Register**/
dataHi = 0x6A;//6F;//6A
dataLo = 0x59;//59;//FF
SPI_DRV8711_ReadWrite(dataHi, dataLo);
/**Write STATUS Register**/
dataHi = 0x70;//6A
dataLo = 0x00;//FF
SPI_DRV8711_ReadWrite(dataHi, dataLo);
ReadAllRegisters();
}