Added timeouts to catapult commands.
Fixed winch rotation
Initialise subsystems in correct order.
More diagnostic info added to Smart Dashboard/Live Window.

Live Window allows interactive testing - setting motor speeds, etc by hand.