Adds first working position estimation