Added subscriber in Environment class to obtain values from PTrackingBridge, pass down nodehandle from Environment into Simulator instantiations, check for odometry update if robot moved into doStep function