Adds proper #ifs

Defined macros for each manipulator subsystem and added proper #ifs in
OutputManager to control outputs