Way Point Navigation for GPS

Hi I am trying to make a automus robot wiht my arduino and GPS sheild. The Motors and things work fine and I can read GPS data fine, parse it, and figure out the distance from a specific point. But I have no Idea how to get it to go there. could someone help or point me to a tutorial. I looked at the ardupilot code but could not really understand it.

-Thanks