Autonomus Update: Functions

Added functions that would hopefully work.
Since we still don't have a test chasis, the encoder issue is still not
resolved.