aaa
Fork of Move by
Diff: move.cpp
- Revision:
- 25:fa9b75c175fd
- Parent:
- 24:d041fc34d846
- Child:
- 26:0584d68e8f30
--- a/move.cpp Sat Sep 10 17:30:41 2016 +0000 +++ b/move.cpp Sat Sep 10 17:33:19 2016 +0000 @@ -127,7 +127,6 @@ while(1) { update(); - //pc.printf("t:%f\n\r", coordinateTheta()); if(rad - 0.2 < coordinateTheta() && coordinateTheta() < rad + 0.2) { move(0,0); break; @@ -151,7 +150,6 @@ while(1) { update(); - //pc.printf("t:%f\n\r", coordinateTheta()); if(rad - 0.2 < coordinateTheta() && coordinateTheta() < rad + 0.2) { move(0,0); break; @@ -250,10 +248,6 @@ } else if(absd_length < 300) { daikei = absd_length / 300.0; } - /* - else if(absd_length > length - 30) { - daikei = abs(length - absd_length) / 30.0; - */ else daikei = 1; @@ -329,7 +323,7 @@ daikei * (leftspeed *(1-ratio) + k*disorder + k_theta*dtheta) + leftspeed *ratio); - pc2.printf("length:%f, d_length:%d, vx:%d, vy:%d\n\r", length, d_length, virtual_coordinateX(), virtual_coordinateY()); + //pc2.printf("length:%f, d_length:%d, vx:%d, vy:%d\n\r", length, d_length, virtual_coordinateX(), virtual_coordinateY()); if(d_length <= 0) { move(0, 0); break;