Removed redundant, slight increase to efficiency

Removed redundant/useless code.
Modified motor speed cap to be slightly more efficient. (Motors will not
be >100 and <-100 at same time)