Return To Home with waypoint problem

Have a look at this topic: