New joint calculation in the raven openrave simulator. Still doesn't work though