Emergency stop updates

Made emergency stop halt the motors until emergency condition is lifted.