Revolute and Prismatic joints ported to groovy