ARES / Mbed 2 deprecated Robot2016_2-0

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   RoboClaw mbed StepperMotor

Fork of RoboClaw by Simon Emarre

Files at this revision

API Documentation at this revision

Revision 34:e5500418b0e7, committed 2016-01-26

Comitter:
IceTeam
Date:
Tue Jan 26 17:17:52 2016 +0000
Parent:
32:068bd2b2e1f3
Commit message:
Fonction TestEntraxe;

Changed in this revision

Odometry/Odometry.cpp Show annotated file Show diff for this revision Revisions of this file
Odometry/Odometry.h Show annotated file Show diff for this revision Revisions of this file
main.cpp Show annotated file Show diff for this revision Revisions of this file 
--- a/Odometry/Odometry.cpp	Tue Jan 26 17:02:41 2016 +0000
+++ b/Odometry/Odometry.cpp	Tue Jan 26 17:17:52 2016 +0000
@@ -169,3 +169,24 @@
     //pc.printf("arrivey %d\n\r",pos_prog);
     //pc.printf("X : %3.2f\tY : %3.2f\tTheta : %3.2f\n\r", getX(), getY(), getTheta()*180/PI);
 }
+
+void Odometry::TestEntraxe(int i) {
+    int32_t distance_ticks_left;
+    int32_t distance_ticks_right;
+
+    int32_t pos_initiale_right = m_pulses_right, pos_initiale_left = m_pulses_left;
+
+    double erreur_theta = 2*PI*i - getTheta();
+    if(erreur_theta < 0) {
+        distance_ticks_left = (int32_t) pos_initiale_left + (erreur_theta*m_v/2)/m_distPerTick_left;
+        distance_ticks_right = (int32_t) pos_initiale_right - (erreur_theta*m_v/2)/m_distPerTick_right;
+    } else {
+        distance_ticks_left = (int32_t) pos_initiale_left + (erreur_theta*m_v/2)/m_distPerTick_left;
+        distance_ticks_right = (int32_t) pos_initiale_right - (erreur_theta*m_v/2)/m_distPerTick_right;
+    }
+    
+    roboclaw.SpeedAccelDeccelPositionM1M2(ADR, accel_angle, vitesse_angle, deccel_angle, distance_ticks_right, accel_angle, vitesse_angle, deccel_angle, distance_ticks_left, 1);
+    
+    while((m_pulses_right != distance_ticks_right)&&(m_pulses_left != distance_ticks_left)); 
+    wait(0.4);
+}
\ No newline at end of file

--- a/Odometry/Odometry.h	Tue Jan 26 17:02:41 2016 +0000
+++ b/Odometry/Odometry.h	Tue Jan 26 17:17:52 2016 +0000
@@ -36,6 +36,8 @@
     */
     Odometry(double diameter_right, double diameter_left, double v, uint16_t quadrature, RoboClaw &rc);
 
+    void TestEntraxe(int i);
+    
     /** Les fonctions suivantes permettent de reinitialiser les valeurs de position de l'odometrie.
     */
     void setPos(double x, double y, double theta);

--- a/main.cpp	Tue Jan 26 17:02:41 2016 +0000
+++ b/main.cpp	Tue Jan 26 17:17:52 2016 +0000
@@ -59,6 +59,7 @@
     odo.GotoThet(PI);
     odo.GotoThet(0);*/
     
+    /* Test de la ligne droite aller retour */
     odo.GotoXYT(1000, 1000, 0);
     odo.GotoXYT(0, 1000, PI);
     odo.GotoThet(0);