Enhanced moveToDestination function by scaling movment speed by distance to target. Added framework for soccer SM