Added plotting utility and go-to-angle for the PID demonstration.