Various sensor tests

Added different sensors to prevent damage in autonomous. Also added a
little bit of task control business for the autonomous.