diff --git a/MPC virtual lab/helperfunctions/simAndObserve.m b/MPC virtual lab/helperfunctions/simAndObserve.m
index 9755637..5554c75 100644
--- a/MPC virtual lab/helperfunctions/simAndObserve.m	
+++ b/MPC virtual lab/helperfunctions/simAndObserve.m	
@@ -4,20 +4,24 @@ function simAndObserve(Vx, out, reference)
 XRef = out.simout.time*Vx;
 waypoints = [XRef YRef zeros(length(YRef),1)];
 simulationTime = 10;
-%figure(1)
+figure
 simulateScenario(simulationTime,waypoints,Vx);
-
-
-%figure;
-%add labels and fix not having own figure issue
+figure
 subplot(2,1,1)
 hold on
 plot(reference(:,1),reference(:,2))
 plot(out.tout,YRef);
+legend('Ref. 1 vc 2','YRef vs tout sim.')
+xlabel('Time (s)')
+ylabel('Position (m)')
 hold off
 subplot(2,1,2)
 hold on
 plot(reference(:,1),reference(:,3))
 plot(out.tout,yawRef);
+legend('Ref. 1 vs 3','yawRef vs tout sim.')
+xlabel('Time (s)')
+ylabel('Yaw (rad)')
 hold off
-end
\ No newline at end of file
+set(gcf, 'Visible','on')
+end