Added blocking drive method.
Added basic support for same sided manual autonomous operation.