visualization/overlay.py

def draw_trajectory_on_frame(frame, trajectory):
    for i in range(1, len(trajectory)):
        pt1 = tuple(map(int, trajectory[i-1]))
        pt2 = tuple(map(int, trajectory[i]))
        cv2.line(frame, pt1, pt2, (0, 0, 255), 2)
    return frame