Fixed arms initialization, so they're not flipped. Made the visualization axes fixed. Added constraints for the angles chosen for grasp-state, don't work correctly right now.