Home position is taken from waipoints