本帖最后由 hello怪 于 2017-7-25 22:24 编辑
7 G* _( P) w% z, z4 l! b, c
, R$ p' W8 l& @(视频里面最终轮子与黑线的距离,都不超过6mm,最小距离只有2mm。虽然也有运气成分在里面,不过就结果来讲已经很令人满意了^_^)
优酷视频网址: http://v.youku.com/v_show/id_XMjkxOTU1MjEyNA==.html
V' H: G) j$ V/ b
首先说说车子的设计思路,希望也能对大家有用。我想到的影响车子走直线的因素有以下几个方面:
5 V+ m* v+ @" x, ^8 J0 W1 Y8 w. m- `场地/ a r5 @/ G* V) \( u( H
水平度和光滑度
在家里当然瓷砖的效果是最好的8 E ~- [9 s% H' \
线的直度 虽然规则里说起点终点之间不能有黑线,但是因为没用光感,完全是开环控制,所以也无所谓了。这里就直接用了瓷砖上的黑线来说明车子走的直不直
6 K+ a* z6 _$ X. E# ~
% b: r1 j# J O: Q5 k4 }车子结构. H* W ]* |( [4 `, u6 ~
轮子间距
1 q- _8 x: P' ^. p 轮子间距越大越好,稍微想一下便知
2 G- P6 S0 w8 h Z' K 轮子大小
2 w2 m3 m, S! w+ Z9 Q 轮子直径越小越好,而且轮皮要尽量薄(我这里用的是nxt自带的轮子)
6 V/ n, {2 ^2 |' _ 随动轮的设计; a+ G5 Q( w; a) C, a
随动轮转动时对车子的影响应该尽量小。这里我自己想出了一个设计方案(当然我觉得别人也用过),让车子几乎不受随动轮的影响
/ u; _! |+ j# p% H/ w 重心位置/ e; y+ l; ?, i# Z
重心应该稍稍靠近主动轮以增大主动轮的抓地能力。但是太靠近的话就会降低车子的稳定性,并且升级空间较小
, _+ R1 Y8 F/ w9 F# K. |7 F 结构稳定性 不用说,肯定是越结实越好。但是不能造成重量过大
/ q$ Z7 Y- _, S0 s! |) B# n 轮子个数 有三种方案:平衡车(独轮或双轮),三轮车,四轮或以上。虽然很想做平衡车,但是无奈暂时不会用陀螺仪。四轮的话转角不好把控,而且结构复杂,所以就用了最简单的三轮车。(另外,我个人认为不能拐弯的车子就不能叫车子~叫火车或者轨道炮比较合适。。。)2 H& W0 \* T4 u9 |) G" M4 I+ o6 p9 F
驱动方式 这里我选择了直接由马达驱动轮子,不经过任何齿轮传动,一种简单准确的方式驱动
' ^' z7 U4 w+ T# d; r: f, @$ l: |4 {/ `3 p
控制程序, [8 }, D, e0 r, `
运动过程控制
$ `6 K9 Z/ x5 v$ i; _ 好的程序应该使轮子不打滑,车子运行平稳。由此采取平滑运动的控制方法,让车子开始时(近似)匀加速,直到速度足够(160度每秒)。在开始时,加速度甚至更小,可以参考我的程序(加速度增加->加速度不变->加速度为零)2 T3 a `8 D& V9 l8 J* B/ _7 i
, z2 s1 U0 B2 E3 J调试与运行
, K" S0 F ?2 d4 s3 C/ R 轮子转速调整(车轮大小的设定)
- P E: u. f$ W 这个就没什么办法,只能硬着头皮调了。调整轮子的大小设置,实际上就是调马达转速,没有什么更有效的解决办法% R; m& y! ?# Q! Z9 T
起始位置车子正方向和直线间的夹角, }- {8 W3 j. T3 z4 C
一个非常重要的因素,可谓差之毫厘谬以千里。所以尽可能减小两者的方向差。顺带一提,开环控制的小车,如果最终结果差距在一厘米只内,就已经没有什么可比性了。一厘米之内运气成分占比很大,因为0.01rad(0.5度以内)的夹角足以造成差距一厘米的偏差。这就是开环控制的特点
0 f8 S: ^4 I, @- s5 ?$ F0 {) \% i4 h2 h
% y7 x$ G8 Z4 G2 p5 n
然后上源代码:
* r+ j" z4 v S4 b% C1 Y) A( w1 A- importlejos.robotics.navigation.DifferentialPilot;! u3 U# o8 N) P8 T7 W
- import lejos.util.Delay;
" R2 o- ^# V8 c' w. R - ( T- z4 N% Q' k5 w6 d7 z& y7 q8 v8 V3 R! W
- /**
1 K; E" {* s" J - *Robot that stops if the buttons are presses before it completes its travel./ e# P7 D* U: C, h$ |( T
- */
5 Q: \" }! k- I: X# S - " C/ V6 l: l( u; e6 U4 A/ z: o
- 9 x7 q7 c4 L5 k' Y2 Y: G
- public class Straight {' I! R1 n; G$ l( r
- DifferentialPilotpilot;
; l$ g1 l* d: ]+ S5 Q; ~" s - doubleleftD = 4.3, rightD = 4.3;! c# u! Q0 Y( b- k
- , O) L+ C8 f3 a Y& z& e) n% U
- publicvoid adjust() {
( F6 a `- R: ^+ ~( D6 p3 X - //wait for release8 ~, \2 N! T2 k$ z
- while(Button.readButtons() > 0)
3 o+ Y& ^& r3 K$ n6 o( U) Z! h8 s: F - ;
e$ M L! ^6 T: y3 ? - while(Button.readButtons() == 0) {
% T. B1 D3 n' Y0 w# l0 C1 `9 z - //input size by adjusting the wheels4 F% k8 ?1 V+ {# c0 S( U( m4 L
- rightD= (double) (Motor.A.getTachoCount()) / 2160 + 4.3;3 e; S1 ~- E, B! A0 k: G
- leftD= (double) (Motor.B.getTachoCount()) / 2160 + 4.3148;// 调试所得值
" E/ Q1 Q3 U5 [" t" `; D, O - 9 k0 h1 v! @0 {- w; Y2 I
- //display the size input7 E+ m; N+ _2 L; Q! N o7 i/ p
- LCD.drawString("L:"+ String.valueOf(leftD), 0, 0);
# r/ T( d4 l/ d6 S- b* I9 T1 t1 u - LCD.drawString("R:"+ String.valueOf(rightD), 0, 1);1 N4 y- d& Z& h8 l2 s
- Delay.msDelay(100);( Y2 |0 F/ m7 m) c( ^
- LCD.clear();+ U& X- r( V+ w' ^
- }
4 ?7 @0 N/ t9 [* |4 ?7 l' g G
/ W! Z9 n$ F9 x0 V# {4 ?& c- }
0 l8 Y0 w2 L. O: Y
2 p; Y M2 ~5 v& v$ Z2 @7 u: h- publicvoid go() {8 h- p* g+ S" x
- //准备起步3 O. B' J: m4 w$ n) L
- //wait for release
) R" V7 f8 W# r% b - while(Button.readButtons() > 0)% n& B7 a8 T7 D+ Q) G
- ;
1 R; R/ A& r1 W0 E/ a8 W - System.out.println("pressto go");1 L$ S3 s9 M* |$ K! `. Z: C$ N
$ e' z4 f; V- |2 `, H$ t$ ~- Button.waitForAnyPress();+ u* m6 e7 d6 T ~% t: p
- LCD.clear();3 h! f9 w% F- T" m! l
7 {1 |! a& ?. [/ R$ Y- //初始化
1 }/ g+ n k/ y" C - pilot= new DifferentialPilot(rightD, leftD, 13.5, Motor.A, Motor.B, true); B+ `" E" w- x' g/ p& m6 S
- pilot.reset();& v9 r$ G% H8 n8 ~
# K ^. a$ B7 C3 Y& W- Delay.msDelay(3000);
2 o+ A" I4 z& L$ R; ~& T
! C( V6 h' I1 Z% U" y1 w* L- doublespeed = 10;
+ w7 i6 s1 X$ z% f1 ]+ \ - doubledistance = 0;
+ O2 x+ X6 J9 A
9 Z5 O) J3 O6 H7 \7 p- //起步加速
3 `$ t% H+ V6 o2 | - pilot.travel(300,true);) u2 |! {2 T, k' M* g
$ E) U! K7 c# x( D' y1 o- while(distance < 20) {& g( I* m* k) [: F: L& `/ A- |+ U
- distance= pilot.getMovement().getDistanceTraveled();. o0 |+ Z' Y0 z8 [6 |
- speed= distance * 5 + 10;
7 f8 x, [1 c6 c5 G: X! a7 Y - pilot.setRotateSpeed(speed);
8 m4 q; x5 M$ Y3 K% M5 M+ o - Delay.msDelay(100);- k$ P" F# j+ }7 q. Q0 y4 k
- }
x5 }3 ]3 P1 D1 z# q: {, o) q3 K - for(int i = 0; i < 10; i++) {* z' h3 `% ?% ?2 T3 R4 ~# D/ D
- speed+= 5;
4 T5 k6 f" s) d+ C8 R* g! x& ?( n( y - pilot.setRotateSpeed(speed);) `8 q) O5 Q; F
- Delay.msDelay(200);
: L; f' u' {% R - }7 O, \6 G. g8 a3 T, r- K) ?$ @0 Z4 k
% A* @2 T, w- }. T! M- {/ G! {- //TODO 减速7 C6 D0 c5 a5 F" h* {, j* q5 ^4 H
& E5 ?9 m6 ^) V5 T( B( p- //停止机能( n' ?% {. q; { q( Y- M6 w6 x5 ^4 c
- while(pilot.isMoving()) {/ V& z, b% |; z( v; v8 O; U5 G( g
- if(Button.readButtons() > 0) I) H* n6 |; I$ F+ V! l8 [: z- I
- pilot.stop();! M% R+ R3 a- P! A# J3 H( J
- }; v0 N v/ Z7 c/ ^
8 B. J5 \- n" t% S% C- System.out.println("" + pilot.getMovement().getDistanceTraveled());) I5 {6 g0 @; _
- System.out.println(-Motor.A.getTachoCount());
8 F5 `( @2 a' f4 K/ j7 [& q" { - System.out.println(-Motor.B.getTachoCount());
' ]" k8 _0 {3 L6 P/ Q8 i! q - Button.waitForAnyPress();
6 F% j5 P% f% o) c - }! F/ d$ t8 S8 f+ B
2 y5 g% A. e; `5 y& \3 O- publicstatic void main(String[] args) {
, C8 e+ m& q3 C* _$ r; g - Straighttraveler = new Straight();, `/ {" c. q. T6 k; B7 [5 s1 D8 `
M: x) M5 c+ `; w6 c/ K* v- traveler.adjust();# j$ `* B/ J0 f* x2 F h* Z
- traveler.go();
& F& C) ]; p1 t4 j( T0 _+ n - }9 [ m& y: |! O2 V& w( e) E0 ]
- }
复制代码
" g. w7 {9 w5 O) Z' h" ~ |