Robot's source code

Dependencies:   mbed

Revision:
42:fcb48e2fc426
Parent:
41:c04c2ec37aad
Child:
43:87bdce65341f
--- a/Asservissement/Asserv.h	Wed Mar 18 12:25:33 2015 +0000
+++ b/Asservissement/Asserv.h	Wed Mar 18 13:47:40 2015 +0000
@@ -228,6 +228,7 @@
 template<typename T>
 Mat<T> motion_bicycle3( Mat<T> state, Mat<T> command, T dt)
 {
+    logger.printf("motion\r\n");
     Mat<T> bicycle(3,1);
     bicycle.set((T)36, 1,1);  /*radius*/
     bicycle.set((T)36, 2,1);
@@ -295,6 +296,7 @@
 template<typename T>
 Mat<T> jmotion_bicycle3( Mat<T> state, Mat<T> command, T dt)
 {
+    logger.printf("jmotion\r\n");
     T h = sqrt(numeric_limits<T>::epsilon())*norme2(state)+ pow(numeric_limits<T>::epsilon(), (T)0.5);
     Mat<T> var( (T)0, state.getLine(), state.getColumn());
     var.set( h, 1,1);