defined function to draw course points

Author: ShisatoYano

src/components/course/cubic_spline_course/cubic_spline_course.py

@@ -50,6 +50,13 @@ def __init__(self, x_ref_points, y_ref_points, target_speed_kmph, resolution=0.1
         self.speed_array[-1] = 0.0
 
         self.color = color
-
-
-csc = CubicSplineCourse([0.0, 10.0, 25, 40, 50], [0.0, 4, -12, 20, -13], 10)
+    
+    def draw(self, axes, elems):
+        """
+        Function to draw points on course
+        axes: Axes object of figure
+        elems: List of plot objects
+        """
+        
+        course_plot, = axes.plot(self.x_array, self.y_array, linewidth=0, marker='.', color=self.color, label="Course")
+        elems.append(course_plot)