Initial combining of IK and openrave looks good. orientation still looks off though, may be a frame issue