本帖最后由 hello怪 于 2017-7-25 22:24 编辑 $ w c6 ~$ {" U3 N& |
8 r7 u- D) A0 n: M
(视频里面最终轮子与黑线的距离,都不超过6mm,最小距离只有2mm。虽然也有运气成分在里面,不过就结果来讲已经很令人满意了^_^)
优酷视频网址: http://v.youku.com/v_show/id_XMjkxOTU1MjEyNA==.html
4 O! d6 o9 B4 s
首先说说车子的设计思路,希望也能对大家有用。我想到的影响车子走直线的因素有以下几个方面:
. v3 |7 x8 N! X6 {6 y场地
* L, x) q% w- h( K( I" j. f 水平度和光滑度
在家里当然瓷砖的效果是最好的5 X* H$ e/ K, V
线的直度 虽然规则里说起点终点之间不能有黑线,但是因为没用光感,完全是开环控制,所以也无所谓了。这里就直接用了瓷砖上的黑线来说明车子走的直不直' x5 ~$ h6 P- o0 P
7 N, F, S* _9 _3 K
车子结构
( u0 j& G3 V' H6 g! c& _ 轮子间距+ @3 {$ f+ c) H1 ^0 P0 r, E
轮子间距越大越好,稍微想一下便知$ S6 I% i8 G) a Q% H0 y
轮子大小) g9 I# B" i0 I
轮子直径越小越好,而且轮皮要尽量薄(我这里用的是nxt自带的轮子)) t4 v7 H: d6 m. u2 a
随动轮的设计
$ S6 R, i4 o3 W7 m4 g 随动轮转动时对车子的影响应该尽量小。这里我自己想出了一个设计方案(当然我觉得别人也用过),让车子几乎不受随动轮的影响
3 h# V1 U+ N; ^ 重心位置& q! o' s' I9 G: e
重心应该稍稍靠近主动轮以增大主动轮的抓地能力。但是太靠近的话就会降低车子的稳定性,并且升级空间较小5 m7 O% }4 H! w: [
结构稳定性 不用说,肯定是越结实越好。但是不能造成重量过大
8 Y3 @4 K+ t$ z4 F* D/ v) @5 d 轮子个数 有三种方案:平衡车(独轮或双轮),三轮车,四轮或以上。虽然很想做平衡车,但是无奈暂时不会用陀螺仪。四轮的话转角不好把控,而且结构复杂,所以就用了最简单的三轮车。(另外,我个人认为不能拐弯的车子就不能叫车子~叫火车或者轨道炮比较合适。。。)" P: W1 }5 ^; u" a X5 x5 }, h
驱动方式 这里我选择了直接由马达驱动轮子,不经过任何齿轮传动,一种简单准确的方式驱动$ J7 l: O& L$ H! M$ F' m1 ^
" l& j4 ?( U! h! O3 _$ r+ F, v控制程序: a3 i" x+ S9 S9 K' N' L ~- t
运动过程控制+ Q4 A) J" J* M3 B6 Z
好的程序应该使轮子不打滑,车子运行平稳。由此采取平滑运动的控制方法,让车子开始时(近似)匀加速,直到速度足够(160度每秒)。在开始时,加速度甚至更小,可以参考我的程序(加速度增加->加速度不变->加速度为零)# w; J$ c* J2 v9 L: f% h
7 F( k5 `; k1 X* m调试与运行- Y' ]# ?9 Z/ j! E7 ^0 Z
轮子转速调整(车轮大小的设定)# s# |3 `/ y8 A! G6 n3 Q
这个就没什么办法,只能硬着头皮调了。调整轮子的大小设置,实际上就是调马达转速,没有什么更有效的解决办法/ x2 d% B2 U4 b9 N- G( D
起始位置车子正方向和直线间的夹角2 u, S/ I9 u7 J7 ?) J
一个非常重要的因素,可谓差之毫厘谬以千里。所以尽可能减小两者的方向差。顺带一提,开环控制的小车,如果最终结果差距在一厘米只内,就已经没有什么可比性了。一厘米之内运气成分占比很大,因为0.01rad(0.5度以内)的夹角足以造成差距一厘米的偏差。这就是开环控制的特点
% a9 C$ t0 `$ b5 R' N! }, e8 s- t& l# ^0 D: q5 }5 ?
_& F' a2 i6 J- i/ f7 X* a 然后上源代码: - 5 ^+ |1 r) g4 e) L! ~
- importlejos.robotics.navigation.DifferentialPilot;
( r6 T, C# F9 O/ Q' |3 g - import lejos.util.Delay;2 x" f) r4 J& `- |8 Y e" B
- 0 j: M3 Z; ~' a+ _) h/ x" n1 J
- /**
% \5 ?8 G' o4 V - *Robot that stops if the buttons are presses before it completes its travel.
6 k# q/ O* `8 P2 S; e& D, x: A# p - */6 \: j- G( V8 R" k2 n
3 M) w4 l/ `9 }4 Z! {) k; p
3 M0 h& x( y9 A* |0 z& ^& w& q: U- public class Straight {. X! t2 A. C' f% p& a# b
- DifferentialPilotpilot;
" k$ L, Q) ^' j# K, n& I( G - doubleleftD = 4.3, rightD = 4.3;$ x9 f l: I% c" q+ k9 S
9 [/ o& B3 l& u( G, F' C) p n- publicvoid adjust() { Z8 Q2 w1 n) p6 _7 d, ]+ Y
- //wait for release( y1 `3 V1 P; u; S$ t$ T( ~& x0 {+ v
- while(Button.readButtons() > 0)
) j( G( |* H, e# a* g8 W* S# |5 O - ;
5 F4 {+ c" T: b5 ~7 l - while(Button.readButtons() == 0) {
) k7 t" g/ Y7 H, I# H1 l - //input size by adjusting the wheels9 \6 o# Z0 O+ }1 C$ h: T+ y/ @! A
- rightD= (double) (Motor.A.getTachoCount()) / 2160 + 4.3;, Q3 Q4 Q; `4 T5 U
- leftD= (double) (Motor.B.getTachoCount()) / 2160 + 4.3148;// 调试所得值
$ \2 p# [2 ^$ f" {0 J1 D' f - + M F3 w7 @. l A c! z6 Z+ C4 {, J
- //display the size input& m: o, y {5 }8 e
- LCD.drawString("L:"+ String.valueOf(leftD), 0, 0);6 ~. p2 s# _9 _
- LCD.drawString("R:"+ String.valueOf(rightD), 0, 1);
: d a( q/ M) O U - Delay.msDelay(100);
. o, R6 m# `8 D - LCD.clear();
+ t N$ `8 u8 I' j" T+ F1 t: c - }
. q/ Z5 x; d9 z; N4 W - 7 k) f5 ]2 [# t0 Z4 ` D
- }/ L" A; V- o" j0 V- S
- * _7 K' P+ O! V. g3 d6 G
- publicvoid go() {: @8 O) q0 I( x9 f
- //准备起步$ C6 p* p8 {) |/ H7 U! i2 r5 F
- //wait for release3 K) Y4 a7 ]( m( O1 N
- while(Button.readButtons() > 0)/ B7 g4 O5 ?! ~# \* u& k: p2 @: O- y
- ;
+ Q: x2 F: _5 c( s - System.out.println("pressto go");
% U, B) ~0 z9 c, u: z
8 p0 u5 ]1 b: R4 U1 Q2 I- Button.waitForAnyPress();6 c% c- w0 ~9 g5 o- T% c3 H
- LCD.clear();
5 v' W7 ?3 M5 y9 [ - & V: m# i P7 c1 P
- //初始化0 d- H& ?: I1 Z8 J5 X# D
- pilot= new DifferentialPilot(rightD, leftD, 13.5, Motor.A, Motor.B, true);4 X7 u' ]3 q- \
- pilot.reset();5 f# y9 t6 U( h, |
4 a+ |0 m. b1 K) }2 B2 E- Delay.msDelay(3000);
, i* i# _8 z& K - 6 }" i0 p% C# }1 A+ R5 t5 G$ F
- doublespeed = 10;
& h" F5 B3 a6 m! o' z4 v - doubledistance = 0;5 g0 I4 f! S9 m
9 l0 J) v; Z7 K, g- //起步加速
$ O3 t$ N M% r: p/ I0 K - pilot.travel(300,true);
- E- Z/ w! n3 B- ^ n+ v; C" H
# ^; ]' Z! s0 M7 T0 ]- while(distance < 20) {# [8 W, g( F7 t N4 K& c# T# G
- distance= pilot.getMovement().getDistanceTraveled();
. A4 c! }* ~; c3 Q$ d - speed= distance * 5 + 10;) X6 i) E! r8 _# |7 z* o
- pilot.setRotateSpeed(speed);
( i+ H# K" w' W# { - Delay.msDelay(100);
2 _- k6 i0 [0 S" ^ - }7 i+ e; Y {* c3 m
- for(int i = 0; i < 10; i++) {
4 W/ L. j6 T+ |8 o R - speed+= 5;' f! {- L2 w7 P: c
- pilot.setRotateSpeed(speed);
; a. d) A N; \4 q5 ? - Delay.msDelay(200);
/ B5 D1 A) h+ ?6 \ - }
R' y1 c% |- ^; u* a5 u
% E I1 ~! {) o+ _4 z- //TODO 减速, R& f1 g, V `% B7 J3 E
- 4 b% L% T' {; ?# d) N, {
- //停止机能
; M4 \/ ?) u' |1 G - while(pilot.isMoving()) {" y0 Q& [4 ?, d2 i X$ l
- if(Button.readButtons() > 0)( b9 O6 O% O/ ]3 m
- pilot.stop();
% j |7 ?8 f% t5 p5 S& g2 O, j O - }
5 r0 z( ^ u6 x$ u5 f
" k, e& F& k. e6 t% [" P4 h r- i: u: M- System.out.println("" + pilot.getMovement().getDistanceTraveled());! v" t+ {2 l' O& g) ?+ O
- System.out.println(-Motor.A.getTachoCount()); F4 f1 f+ C! N) o
- System.out.println(-Motor.B.getTachoCount());( U/ G9 R1 W( q: }" f: F' H! r5 q
- Button.waitForAnyPress();
0 Y7 f* s- ?8 J r: \! N% m - }9 C; }3 t2 F) l3 {1 V4 C& B1 T
. l0 z. `9 g) P. [! J9 q- publicstatic void main(String[] args) {" V, l' |( b6 S( p7 _9 ^; `
- Straighttraveler = new Straight();
) I+ D) ^* ?0 ]4 v - O' I' i: e* J
- traveler.adjust();
% ~1 D, u+ J# Z/ R5 d - traveler.go();
2 b. [+ G: E& h - }. H# R% f! ]/ J( P) a4 ^
- }
复制代码
' j4 B1 y7 k* P( g; ~) Q* F3 W |