Added getTotalDisplacement in autonomous and getDistance in config