Survey (Grid) Move DO_SET_CAM_TRIGG_DIST to after the first waypoint.

Part of Issue: #579.

Also noticed when in Imperial mode, the altitude set by GRID into waypoints could be a decimal. FIXED: Change to a whole number.