Set a few commands for motor control, and added HCF routine for when things go horribly wrong.