Made some changes so that const references to vectors of joint angles are passed. Also, added an argument to the constructor for compatibility with visualizing collisions in TAR project
Merge remote-tracking branch 'origin/groovy' into groovy