with class

Dependencies:   ISR_Mini-explorer mbed

Fork of VirtualForces by Georgios Tsamis

Revision:
39:890439b495e3
Parent:
37:b4c45e43ad29
--- a/MiniExplorerCoimbra.hpp	Thu Jun 15 23:17:55 2017 +0000
+++ b/MiniExplorerCoimbra.hpp	Fri Jun 16 10:40:53 2017 +0000
@@ -5,9 +5,6 @@
 #include "Sonar.hpp"
 #include<math.h>
 
-
-
-
 	/*
 Robot coordinate system:      			World coordinate system:
       ^                 							^
@@ -71,6 +68,10 @@
 	
 	void vff(bool* reached, float targetXWorld, float targetYWorld);
 	
+	void procedure_lab_4(float xEstimatedK,float yEstimatedK, float thetaWorldEstimatedK, float distanceMoved, float angleMoved, float PreviousCovarianceOdometricPositionEstimate[3][3]){
+
+	void test_procedure_lab_4();
+	
 	//compute the force on X and Y
 	void compute_forceX_and_forceY(float* forceXWorld, float* forceYWorld, float targetXWorld, float targetYWorld);