Fixed control_toolbox deprecated errors with updatePid()