Fixing Shiz

Fixing Initialisation, Integrating digital limit switches, Ignoring
Colour Sensor, Switching Direction of Front Servo