Add constraint for waypoints

Change-Id: I8156920d4d3d85aee060b9d0fe925f43f9b15ff1
3 files changed