Fixed drivetrain encoder ports.
Adjusted wait times for shooting sequence.
Added scaling for ultrasonic sensor and getUltrasonicSensor method.