Reads from config and input port, writes to output port, status port pending...
Added configuration to read from camera or simulation
Updated to new config, little clean up.
Dummyfied a little more
Some configurations to do test
Clean up