Operating a PIDSubsystem from a command in C++