control loop almost finished, need to tweek speed which commands are being recieved and sent