Update positioncontrol.cc