Added more general computeCartesianPath, takes vector of waypoints
improving code
Merge pull request #42 from marioprats/groovy-devel

Added more general computeCartesianPath, takes vector of waypoints