Motor Mount and Wheel Kit (#27971) issues

richardmyno

I just bought my Motor Mount and Wheel Kit (#27971) with two HB-25 Motor Controllers. I'm just using the right motor and one the HB-25's to check how it works. The problem is that when I send a value that make the wheel move(TRVL command) for about 10 seconds it stops and starts to shake. I'm trying to send another value to the position controller to make do something different (for instance just move for about 5 seconds), but it doesn't work. The posistion controller is so destend to move the wheel for 10 seconds and start to shake that is doesn't matter what I do... I've created a monster!

The jumpers are OK (the ID is 001, A&B is jumped), (I hope) my baudrate is OK and the jumper on my HB-25 is in place. I don't seem to see what the problem is. Any suggestions?

My C-code:

while(1)
{
while( (USART.STATUS & USART_DREIF_bm) == 0 ) {}
USART.DATA = 0b00100001; // Sends TRVL command and ID
_delay_ms(8);
USART.DATA = 0b00100000; // Value to be sent [H]
_delay_ms(8);
USART.DATA = 0b00000000; // Value to be sent [L]
_delay_ms(8);
USART.CTRLB = 0x10; //Disables TX so it just sends ONE pulse.
}

Thanks!