Posture Optimization in p-HRI and Teleoperation