Position force control with irp6 robot