Added a StateValidityChecker and fixed SEGFAULT

Thanks Jen King for the help in debugging this. It turns out that many
functions in OMPL SEGFAULT if a StateValidityChecker has not been set on
the state space. This seems like a bug.