找回密码
 马上注册

QQ登录

只需一步,快速开始

查看: 11000|回复: 7

最直的三百厘米——开环控制的小车

[复制链接]
发表于 2017-7-25 22:09:23 | 显示全部楼层 |阅读模式
本帖最后由 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
然后上源代码:

  1. * r+ j" z4 v  S4 b% C1 Y) A( w1 A
  2. importlejos.robotics.navigation.DifferentialPilot;! u3 U# o8 N) P8 T7 W
  3. import lejos.util.Delay;
    " R2 o- ^# V8 c' w. R
  4. ( T- z4 N% Q' k5 w6 d7 z& y7 q8 v8 V3 R! W
  5. /**
    1 K; E" {* s" J
  6. *Robot that stops if the buttons are presses before it completes its travel./ e# P7 D* U: C, h$ |( T
  7. */
    5 Q: \" }! k- I: X# S
  8. " C/ V6 l: l( u; e6 U4 A/ z: o
  9. 9 x7 q7 c4 L5 k' Y2 Y: G
  10. public class Straight {' I! R1 n; G$ l( r
  11.   DifferentialPilotpilot;
    ; l$ g1 l* d: ]+ S5 Q; ~" s
  12.   doubleleftD = 4.3, rightD = 4.3;! c# u! Q0 Y( b- k
  13. , O) L+ C8 f3 a  Y& z& e) n% U
  14.   publicvoid adjust() {
    ( F6 a  `- R: ^+ ~( D6 p3 X
  15.            //wait for release8 ~, \2 N! T2 k$ z
  16.            while(Button.readButtons() > 0)
    3 o+ Y& ^& r3 K$ n6 o( U) Z! h8 s: F
  17.                    ;
      e$ M  L! ^6 T: y3 ?
  18.            while(Button.readButtons() == 0) {
    % T. B1 D3 n' Y0 w# l0 C1 `9 z
  19.                    //input size by adjusting the wheels4 F% k8 ?1 V+ {# c0 S( U( m4 L
  20.                    rightD= (double) (Motor.A.getTachoCount()) / 2160 + 4.3;3 e; S1 ~- E, B! A0 k: G
  21.                    leftD= (double) (Motor.B.getTachoCount()) / 2160 + 4.3148;// 调试所得值
    " E/ Q1 Q3 U5 [" t" `; D, O
  22. 9 k0 h1 v! @0 {- w; Y2 I
  23.                    //display the size input7 E+ m; N+ _2 L; Q! N  o7 i/ p
  24.                    LCD.drawString("L:"+ String.valueOf(leftD), 0, 0);
    # r/ T( d4 l/ d6 S- b* I9 T1 t1 u
  25.                    LCD.drawString("R:"+ String.valueOf(rightD), 0, 1);1 N4 y- d& Z& h8 l2 s
  26.                    Delay.msDelay(100);( Y2 |0 F/ m7 m) c( ^
  27.                    LCD.clear();+ U& X- r( V+ w' ^
  28.            }
    4 ?7 @0 N/ t9 [* |4 ?7 l' g  G

  29. / W! Z9 n$ F9 x0 V# {4 ?& c
  30.   }
    0 l8 Y0 w2 L. O: Y

  31. 2 p; Y  M2 ~5 v& v$ Z2 @7 u: h
  32.   publicvoid go() {8 h- p* g+ S" x
  33.            //准备起步3 O. B' J: m4 w$ n) L
  34.            //wait for release
    ) R" V7 f8 W# r% b
  35.            while(Button.readButtons() > 0)% n& B7 a8 T7 D+ Q) G
  36.                    ;
    1 R; R/ A& r1 W0 E/ a8 W
  37.            System.out.println("pressto go");1 L$ S3 s9 M* |$ K! `. Z: C$ N

  38. $ e' z4 f; V- |2 `, H$ t$ ~
  39.            Button.waitForAnyPress();+ u* m6 e7 d6 T  ~% t: p
  40.            LCD.clear();3 h! f9 w% F- T" m! l

  41. 7 {1 |! a& ?. [/ R$ Y
  42.            //初始化
    1 }/ g+ n  k/ y" C
  43.            pilot= new DifferentialPilot(rightD, leftD, 13.5, Motor.A, Motor.B, true);  B+ `" E" w- x' g/ p& m6 S
  44.            pilot.reset();& v9 r$ G% H8 n8 ~

  45. # K  ^. a$ B7 C3 Y& W
  46.            Delay.msDelay(3000);
    2 o+ A" I4 z& L$ R; ~& T

  47. ! C( V6 h' I1 Z% U" y1 w* L
  48.            doublespeed = 10;
    + w7 i6 s1 X$ z% f1 ]+ \
  49.            doubledistance = 0;
    + O2 x+ X6 J9 A

  50. 9 Z5 O) J3 O6 H7 \7 p
  51.            //起步加速
    3 `$ t% H+ V6 o2 |
  52.            pilot.travel(300,true);) u2 |! {2 T, k' M* g

  53. $ E) U! K7 c# x( D' y1 o
  54.            while(distance < 20) {& g( I* m* k) [: F: L& `/ A- |+ U
  55.                    distance= pilot.getMovement().getDistanceTraveled();. o0 |+ Z' Y0 z8 [6 |
  56.                    speed= distance * 5 + 10;
    7 f8 x, [1 c6 c5 G: X! a7 Y
  57.                    pilot.setRotateSpeed(speed);
    8 m4 q; x5 M$ Y3 K% M5 M+ o
  58.                    Delay.msDelay(100);- k$ P" F# j+ }7 q. Q0 y4 k
  59.            }
      x5 }3 ]3 P1 D1 z# q: {, o) q3 K
  60.            for(int i = 0; i < 10; i++) {* z' h3 `% ?% ?2 T3 R4 ~# D/ D
  61.                    speed+= 5;
    4 T5 k6 f" s) d+ C8 R* g! x& ?( n( y
  62.                    pilot.setRotateSpeed(speed);) `8 q) O5 Q; F
  63.                    Delay.msDelay(200);
    : L; f' u' {% R
  64.            }7 O, \6 G. g8 a3 T, r- K) ?$ @0 Z4 k

  65. % A* @2 T, w- }. T! M- {/ G! {
  66.            //TODO 减速7 C6 D0 c5 a5 F" h* {, j* q5 ^4 H

  67. & E5 ?9 m6 ^) V5 T( B( p
  68.            //停止机能( n' ?% {. q; {  q( Y- M6 w6 x5 ^4 c
  69.            while(pilot.isMoving()) {/ V& z, b% |; z( v; v8 O; U5 G( g
  70.                    if(Button.readButtons() > 0)  I) H* n6 |; I$ F+ V! l8 [: z- I
  71.                            pilot.stop();! M% R+ R3 a- P! A# J3 H( J
  72.            }; v0 N  v/ Z7 c/ ^

  73. 8 B. J5 \- n" t% S% C
  74.            System.out.println("" + pilot.getMovement().getDistanceTraveled());) I5 {6 g0 @; _
  75.            System.out.println(-Motor.A.getTachoCount());
    8 F5 `( @2 a' f4 K/ j7 [& q" {
  76.            System.out.println(-Motor.B.getTachoCount());
    ' ]" k8 _0 {3 L6 P/ Q8 i! q
  77.            Button.waitForAnyPress();
    6 F% j5 P% f% o) c
  78.   }! F/ d$ t8 S8 f+ B

  79. 2 y5 g% A. e; `5 y& \3 O
  80.   publicstatic void main(String[] args) {
    , C8 e+ m& q3 C* _$ r; g
  81.            Straighttraveler = new Straight();, `/ {" c. q. T6 k; B7 [5 s1 D8 `

  82.   M: x) M5 c+ `; w6 c/ K* v
  83.            traveler.adjust();# j$ `* B/ J0 f* x2 F  h* Z
  84.            traveler.go();
    & F& C) ]; p1 t4 j( T0 _+ n
  85.   }9 [  m& y: |! O2 V& w( e) E0 ]
  86. }
复制代码

" g. w7 {9 w5 O) Z' h" ~
IMG_20170720_111026()().jpg
IMG_20170720_114534()().jpg

轮子外缘与标尺间的距离:半个乐高单位

轮子外缘与标尺间的距离:半个乐高单位
如果您觉得我的帖子对您有用,请不吝给我一个“赞”!
 楼主| 发表于 2017-7-25 22:10:06 | 显示全部楼层
二楼自占备用,欢迎发表评论
如果您觉得我的帖子对您有用,请不吝给我一个“赞”!
回复

使用道具 举报

发表于 2017-7-26 01:34:48 | 显示全部楼层
这个源代码是什么语言呀
如果您觉得我的帖子对您有用,请不吝给我一个“赞”!
回复

使用道具 举报

发表于 2017-7-26 07:22:29 | 显示全部楼层
本帖最后由 clx 于 2017-7-26 07:26 编辑 3 r. j0 e. v6 [4 B6 Z1 D
5 s& T- d; H4 ~* ^! M
这一行行代码,C?,暂还不懂,反正看到写代码的都敬仰,这种程序是不是比G(乐高是不是叫G语言)的严谨,用代码程序的机器人都能很好的实现复杂功能
如果您觉得我的帖子对您有用,请不吝给我一个“赞”!
回复

使用道具 举报

 楼主| 发表于 2017-7-26 10:08:44 | 显示全部楼层
clx 发表于 2017-7-26 07:22
% E. Y. ?  g: @) r这一行行代码,C?,暂还不懂,反正看到写代码的都敬仰,这种程序是不是比G(乐高是不是叫G语言)的严谨, ...

" e! G! S6 y* j7 }" U我用的是lejos,一种基于Java的nxt专用语言。论严谨的话,程序结构的严谨和语言选择是无关的,但是不同的语言确实各有专长。比如这个lejos,他的函数库就比G大若干倍,有很多别人写过的东西可以直接拿来用。虽然G很适合给小朋友和初学者普及(本来就是针对于此),但是图形编程界面本身不适合大项目的编写,如果想要深入玩乐高的话转向代码是必然的
如果您觉得我的帖子对您有用,请不吝给我一个“赞”!
回复

使用道具 举报

发表于 2017-7-26 10:23:44 | 显示全部楼层
学习了,在乐高深入了解方向还不太明确,转代码确实必不可少
如果您觉得我的帖子对您有用,请不吝给我一个“赞”!
回复

使用道具 举报

发表于 2017-7-29 16:34:41 | 显示全部楼层
车子结构很好,赞
如果您觉得我的帖子对您有用,请不吝给我一个“赞”!
回复

使用道具 举报

发表于 2019-8-16 14:40:13 | 显示全部楼层
如果您觉得我的帖子对您有用,请不吝给我一个“赞”!
回复

使用道具 举报

您需要登录后才可以回帖 登录 | 马上注册

本版积分规则

手机版|中文乐高 ( 桂ICP备13001575号-7 )

GMT+8, 2025-9-18 14:14 , Processed in 1.996012 second(s), 21 queries .

Powered by Discuz! X3.5

Copyright © 2001-2020, Tencent Cloud.

快速回复 返回顶部 返回列表