AresENSEA-CDF2020
/
AresCDFMainCode_us2
Test
Diff: debugPC.cpp
- Revision:
- 21:e5f0f5abb5ae
- Parent:
- 20:7d206773f39e
- Child:
- 22:f891c2bce091
--- a/debugPC.cpp Tue Oct 20 17:53:32 2020 +0000 +++ b/debugPC.cpp Sun Oct 25 22:36:51 2020 +0000 @@ -305,9 +305,9 @@ //bt.printf("O = %lf\n\r", (O*180)/_PI_); //bt.printf("vitG = %lf\n\r", vitG); //bt.printf("vitD = %lf\n\r", vitD); - bt.printf("dist 1 = %f\n\r", ::distance[0]); - bt.printf("dist 2 = %f\n\r", ::distance[1]); - bt.printf("dist 6 = %f\n\r", ::distance[5]); + //bt.printf("dist 1 = %f\n\r", ::distance[0]); + //bt.printf("dist 2 = %f\n\r", ::distance[1]); + //bt.printf("dist 6 = %f\n\r", ::distance[5]); bt.printf("fnc = %d\n\r", fnc); break; default: @@ -384,40 +384,42 @@ void affUltrasons() { - /* // Données bruts + /* // pc - if(aff_US[0]) pc.printf("Tps US1 = %5.0f uS\n\r", us_out[0]); - if(aff_US[1]) pc.printf("Tps US2 = %5.0f uS\n\r", us_out[1]); - if(aff_US[2]) pc.printf("Tps US3 = %5.0f uS\n\r", us_out[2]); - if(aff_US[3]) pc.printf("Tps US4 = %5.0f uS\n\r", us_out[3]); - if(aff_US[4]) pc.printf("Tps US5 = %5.0f uS\n\r", us_out[4]); - if(aff_US[5]) pc.printf("Tps US6 = %5.0f uS\n\r", us_out[5]); + if(aff_US[0]) pc.printf("Tps US1 = %5.0f uS\n\r", us_diff[0]); + if(aff_US[1]) pc.printf("Tps US2 = %5.0f uS\n\r", us_diff[1]); + if(aff_US[2]) pc.printf("Tps US3 = %5.0f uS\n\r", us_diff[2]); + if(aff_US[3]) pc.printf("Tps US4 = %5.0f uS\n\r", us_diff[3]); + if(aff_US[4]) pc.printf("Tps US5 = %5.0f uS\n\r", us_diff[4]); + if(aff_US[5]) pc.printf("Tps US6 = %5.0f uS\n\r", us_diff[5]); if(aff_US[0]||aff_US[1]||aff_US[2]||aff_US[3]||aff_US[4]||aff_US[5]) pc.printf("\n\r"); // bt - if(aff_US[0]) bt.printf("Tps US1 = %5.0f uS\n\r", us_out[0]); - if(aff_US[1]) bt.printf("Tps US2 = %5.0f uS\n\r", us_out[1]); - if(aff_US[2]) bt.printf("Tps US3 = %5.0f uS\n\r", us_out[2]); - if(aff_US[3]) bt.printf("Tps US4 = %5.0f uS\n\r", us_out[3]); - if(aff_US[4]) bt.printf("Tps US5 = %5.0f uS\n\r", us_out[4]); - if(aff_US[5]) bt.printf("Tps US6 = %5.0f uS\n\r", us_out[5]); + if(aff_US[0]) bt.printf("Tps US1 = %5.0f uS\n\r", us_diff[0]); + if(aff_US[1]) bt.printf("Tps US2 = %5.0f uS\n\r", us_diff[1]); + if(aff_US[2]) bt.printf("Tps US3 = %5.0f uS\n\r", us_diff[2]); + if(aff_US[3]) bt.printf("Tps US4 = %5.0f uS\n\r", us_diff[3]); + if(aff_US[4]) bt.printf("Tps US5 = %5.0f uS\n\r", us_diff[4]); + if(aff_US[5]) bt.printf("Tps US6 = %5.0f uS\n\r", us_diff[5]); if(aff_US[0]||aff_US[1]||aff_US[2]||aff_US[3]||aff_US[4]||aff_US[5]) bt.printf("\n\r"); */ + // Distances // pc - pc.printf("distance[0] = %f\n\r", ::distance[0]); - //pc.printf("distance[1] = %f\n\r", ::distance[1]); - //pc.printf("distance[2] = %f\n\r", ::distance[2]); - //pc.printf("distance[3] = %f\n\r", ::distance[3]); - //pc.printf("distance[4] = %f\n\r", ::distance[4]); - //pc.printf("distance[5] = %f\n\r", ::distance[5]); + pc.printf("distance[0] = %lf\n\r", distt[0]); + pc.printf("distance[1] = %lf\n\r", distt[1]); + pc.printf("distance[2] = %lf\n\r", distt[2]); + pc.printf("distance[3] = %lf\n\r", distt[3]); + pc.printf("distance[4] = %lf\n\r", distt[4]); + pc.printf("distance[5] = %lf\n\r", distt[5]); pc.printf("\n\r"); // bt + /* bt.printf("distance[0] = %f\n\r", ::distance[0]); bt.printf("distance[1] = %f\n\r", ::distance[1]);