Added speed code and track test scripts that work without a PI.
TODO: Fix redundant code