IK working with 8 configurations

Special case for Z only rotation on wrist not implemented yet