add waypoints and dynamics model as an object in robot class

guided_mrmp/utils/robot.py

@@ -10,6 +10,8 @@ class Robot:
         self.current_position = start
         self.control = np.zeros(2)
         self.rrtpath = rrtpath
+        self.dynamics_model = dynamics_model
+        self.waypoints = waypoints
         
         self.next_step = None
         self.next_control = None