Added dynamic reconfiguration to StateEstimation Object
Better flow control to modify initial conditions
Added Initial Default PID Controller Setup from .yaml file