Guillaume Chauvon / Mbed 2 deprecated Asservissment_robot2_v16_05

l

Dependencies:   mbed Asser2

Diff: odometrie.cpp

Revision:
6:e1585b8bd07d
Parent:
5:3638d7e7c5c1
diff -r 3638d7e7c5c1 -r e1585b8bd07d odometrie.cpp
--- a/odometrie.cpp	Mon May 20 23:08:09 2019 +0000
+++ b/odometrie.cpp	Fri May 24 21:45:17 2019 +0000
@@ -103,16 +103,23 @@
 
 void setEmplacementDepartViolet()
 {
-	X_init = 30000.0; //22500
-	Y_init = 30000.0; // 45000
+	X_init = 22500.0; //22500
+	Y_init = 43500.0; // 45000
 	//ANGLE_init = 0.0; 
-	ANGLE_init = 0.0;
+	ANGLE_init = -90.0*PI/180.0;
 }
 
 
 void setEmplacementDepartJaune()
 {
-	X_init = 0.0;
-	Y_init = 0.0;
-	ANGLE_init = -90.0*3.1415/180.0;
+	X_init = 277500;
+	Y_init = 43500;
+	ANGLE_init = -90.0*PI/180.0;
+}
+
+void setEmplacementTest()
+{
+	X_init = 30000;
+	Y_init = 30000;
+	ANGLE_init = 0.0;
 }
\ No newline at end of file