Finished working with collisions, now onto joint limit constraints