OMPL integration

Someone should look into how we can use Open Motion Planning Library (OMPL) in our code. Look into their API and try to use the existing methods in the library with Drake. Sarp mentioned that Russ mentions it's been implemented (?) into Drake somewhere (probably the textbook)