Pathgen error-checking

[qsctr]

Since the path generator code will now be run directly on the computer interactively, we need to add some safety checks in the code to make sure it doesn't crash. This includes things like checking number of waypoints, checking velocity, etc.