找回密码
 马上注册

QQ登录

只需一步,快速开始

查看: 13434|回复: 7

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

[复制链接]
发表于 2017-7-25 22:09:23 | 显示全部楼层 |阅读模式
本帖最后由 hello怪 于 2017-7-25 22:24 编辑
8 A- D, d0 v: N+ L( O3 \$ A  m; f5 X+ [( R4 W
(视频里面最终轮子与黑线的距离,都不超过6mm,最小距离只有2mm。虽然也有运气成分在里面,不过就结果来讲已经很令人满意了^_^)
优酷视频网址:
http://v.youku.com/v_show/id_XMjkxOTU1MjEyNA==.html

- i$ O! O7 d" {# w+ f2 n# W" n
首先说说车子的设计思路,希望也能对大家有用。我想到的影响车子走直线的因素有以下几个方面:

9 J9 c2 b. B' w: P& v
场地
; X7 A5 m9 T( E1 E& X; B' Q  水平度和光滑度
在家里当然瓷砖的效果是最好的  Q% f0 V' D4 \* O7 b, o/ f# {4 Q( W
  线的直度
虽然规则里说起点终点之间不能有黑线,但是因为没用光感,完全是开环控制,所以也无所谓了。这里就直接用了瓷砖上的黑线来说明车子走的直不直9 z) \0 R8 Z7 b& W. f2 e& V

1 `, O3 Y$ \0 E/ u& h" \车子结构
* N. G9 `) j8 o  轮子间距# {0 \! O* ~+ [, s
     轮子间距越大越好,稍微想一下便知
) H5 V2 ~2 V8 ^; c  轮子大小9 A# r: C$ `0 k7 I9 O  j1 v7 r( d
     轮子直径越小越好,而且轮皮要尽量薄(我这里用的是nxt自带的轮子)/ b! v5 ~* ]5 e0 t' Q! |
  随动轮的设计
- o* K2 N# x' |% m2 Q; X7 i! f     随动轮转动时对车子的影响应该尽量小。这里我自己想出了一个设计方案(当然我觉得别人也用过),让车子几乎不受随动轮的影响/ R* ~! f0 k( v& r; O/ I
  重心位置* C7 n# i) a- _9 L
     重心应该稍稍靠近主动轮以增大主动轮的抓地能力。但是太靠近的话就会降低车子的稳定性,并且升级空间较小
5 M; j+ N. u( O/ q1 x  结构稳定性
不用说,肯定是越结实越好。但是不能造成重量过大
, b5 p1 z& g7 y8 J; a8 b  轮子个数
有三种方案:平衡车(独轮或双轮),三轮车,四轮或以上。虽然很想做平衡车,但是无奈暂时不会用陀螺仪。四轮的话转角不好把控,而且结构复杂,所以就用了最简单的三轮车。(另外,我个人认为不能拐弯的车子就不能叫车子~叫火车或者轨道炮比较合适。。。)1 W3 i( n, S. [5 O
  驱动方式
这里我选择了直接由马达驱动轮子,不经过任何齿轮传动,一种简单准确的方式驱动
5 q& d1 D$ J: q9 Y$ N" t: k+ g4 I( Q1 e5 S8 u( r5 w- E* U
控制程序
6 `# f( b) Y# D1 v  运动过程控制9 M8 r2 |6 [, \( Z
     好的程序应该使轮子不打滑,车子运行平稳。由此采取平滑运动的控制方法,让车子开始时(近似)匀加速,直到速度足够(160度每秒)。在开始时,加速度甚至更小,可以参考我的程序(加速度增加->加速度不变->加速度为零)% g; }) {% u3 x3 ]$ }
6 O8 E  w2 x9 Z
调试与运行7 u* M8 R2 W$ w* E
  轮子转速调整(车轮大小的设定)
" \9 C1 G( K& K4 Y( Z5 V/ _      这个就没什么办法,只能硬着头皮调了。调整轮子的大小设置,实际上就是调马达转速,没有什么更有效的解决办法
( ^$ {# ?1 s% i' O7 ~5 I! F  起始位置车子正方向和直线间的夹角* F+ T# |" i, _$ F: k
      一个非常重要的因素,可谓差之毫厘谬以千里。所以尽可能减小两者的方向差。顺带一提,开环控制的小车,如果最终结果差距在一厘米只内,就已经没有什么可比性了。一厘米之内运气成分占比很大,因为0.01rad(0.5度以内)的夹角足以造成差距一厘米的偏差。这就是开环控制的特点
5 u9 x! K) Y' D5 \2 @1 s6 G
; ~; Y5 }4 v% |9 P0 k3 X  A) z

. u2 }1 [2 G  ?) _9 h7 p
然后上源代码:
  1. : V$ Q" p, E/ ^+ r) `
  2. importlejos.robotics.navigation.DifferentialPilot;
    6 [& ^$ _# q' f3 u4 ~
  3. import lejos.util.Delay;
    . [. [8 X7 I! Y1 @7 c

  4. # F6 f9 q7 I- U' o
  5. /**
    $ P% `: V/ B- I% s, T* s1 n
  6. *Robot that stops if the buttons are presses before it completes its travel.
    8 @  n4 _5 ?: [8 t# a, }+ q
  7. */! p$ }- z3 j7 u. r1 v! B7 x
  8. 2 |3 D6 @, P, D2 q" [! c, e; L

  9. . e' w7 b- e2 T* F5 d8 ]$ |
  10. public class Straight {
    3 P9 i7 o  i- N
  11.   DifferentialPilotpilot;. ~8 r8 J( r/ Y, |: y
  12.   doubleleftD = 4.3, rightD = 4.3;
    1 u1 H0 m) K0 s% e0 C6 l3 {( Q
  13. " g$ A* A' p9 C
  14.   publicvoid adjust() {9 c- M2 l& H! d; d1 Z8 G+ ?. ]
  15.            //wait for release( V7 J& C* S& m: ^3 [; m' ?
  16.            while(Button.readButtons() > 0): E: n$ P$ Z3 {8 r  R3 _, {
  17.                    ;* ~) [. ]. c% o7 l- ~
  18.            while(Button.readButtons() == 0) {. ?- e1 N8 K4 B0 K
  19.                    //input size by adjusting the wheels
    : M$ B" Y2 r" B6 }: Z
  20.                    rightD= (double) (Motor.A.getTachoCount()) / 2160 + 4.3;* k6 A6 c; n1 V1 T  U3 g
  21.                    leftD= (double) (Motor.B.getTachoCount()) / 2160 + 4.3148;// 调试所得值# Y# x; R  r1 I3 I
  22. . G# ~. ?+ u2 U- o4 \2 K: p4 p$ g
  23.                    //display the size input2 S/ s/ I$ Z+ z8 w2 N
  24.                    LCD.drawString("L:"+ String.valueOf(leftD), 0, 0);
    / G* X* V& a: q5 S: E1 Z/ e
  25.                    LCD.drawString("R:"+ String.valueOf(rightD), 0, 1);! V, Q3 e0 ^4 z& l$ q0 c
  26.                    Delay.msDelay(100);( d1 r3 a% y2 w1 D- Q
  27.                    LCD.clear();
    5 Y1 A6 v" S" `
  28.            }; q# N9 p* K' P+ P
  29. . Z8 p$ f5 r4 x3 e1 A; n4 j$ v
  30.   }/ q* |- K% e. p" |3 c' Q
  31. 6 P8 X* K7 \( t/ K0 p/ ]) j# Y( [
  32.   publicvoid go() {9 c/ Z+ B! j! `$ B8 Y  A' ~/ s7 L
  33.            //准备起步8 K& n6 e/ [; Z5 e2 t
  34.            //wait for release/ n$ C# U8 O* q6 U9 h- P
  35.            while(Button.readButtons() > 0)
    ( y6 c; p3 ?, j) V5 h
  36.                    ;
    # q. A  R5 d, @( f* o4 [
  37.            System.out.println("pressto go");
    . X; x9 ~7 t5 ]+ u# Y! V! L
  38. ' ^8 M9 i; P$ b/ g7 O
  39.            Button.waitForAnyPress();
    3 Z# i$ n6 {& F$ o7 ]* R( F2 ~
  40.            LCD.clear();
    ; K# m# q& b7 b" z
  41. 3 |8 \7 T2 x# V/ i+ U, V8 }
  42.            //初始化
      o5 {4 g" k' w0 J+ b9 f
  43.            pilot= new DifferentialPilot(rightD, leftD, 13.5, Motor.A, Motor.B, true);* k- n, p2 n* @
  44.            pilot.reset();
    ( f$ J! ~' k/ o# T0 g7 K7 S" k1 {

  45. & C# {! j( ^1 D: w
  46.            Delay.msDelay(3000);' h7 D5 l& |5 ~0 j2 E/ S
  47. 5 A6 a# `' c7 q4 c  [! N6 }9 g
  48.            doublespeed = 10;
    0 V- S$ i: ?! |- Q+ B" A+ u: ~
  49.            doubledistance = 0;8 B. t. u  Z7 [4 g2 q
  50. ( E1 U2 ~$ z" v0 Q
  51.            //起步加速
    ) t( S) S9 X8 X/ J
  52.            pilot.travel(300,true);
    7 N4 g; a6 G3 I+ \7 C0 ^
  53. 0 z$ C+ q9 `2 q; F) R. C5 Y
  54.            while(distance < 20) {5 b/ W0 P" ?4 g# s9 s) ?1 e7 n
  55.                    distance= pilot.getMovement().getDistanceTraveled();
    4 w- g0 t3 J: {2 C
  56.                    speed= distance * 5 + 10;! k/ U" ^) I3 x: X: K
  57.                    pilot.setRotateSpeed(speed);
    - Q, g! y8 X1 ~. ]
  58.                    Delay.msDelay(100);
    8 f3 i& f% i" l$ ?% N, s
  59.            }
    % }9 i9 a; T9 C  A" g
  60.            for(int i = 0; i < 10; i++) {! r! s- ^$ d7 D
  61.                    speed+= 5;! h8 f! f7 @) R" \, u6 h
  62.                    pilot.setRotateSpeed(speed);6 I: l) ~4 e6 K
  63.                    Delay.msDelay(200);) n! y! X5 r8 v7 W
  64.            }
    7 }8 u! ?6 l" [  E& j- l

  65. , B! ]$ ~: C% L+ n
  66.            //TODO 减速
    2 a- P  u& w8 ^9 m$ |1 M

  67. 3 z; N7 ?, C0 M1 h4 Y( J- s
  68.            //停止机能
    1 {$ m$ F1 [+ s- W
  69.            while(pilot.isMoving()) {
    " B5 Y8 ~# k$ f3 M7 z5 x
  70.                    if(Button.readButtons() > 0): u1 O! f+ E5 x0 o7 p
  71.                            pilot.stop();, l6 P$ n8 S# l7 y
  72.            }
      E9 u2 P7 v$ b7 Y* K
  73. 6 @, U! C; f* y4 G5 G
  74.            System.out.println("" + pilot.getMovement().getDistanceTraveled());- F) J$ u# |  z
  75.            System.out.println(-Motor.A.getTachoCount());
      v, H8 r0 Y1 p
  76.            System.out.println(-Motor.B.getTachoCount());- B/ C! q$ W9 a0 Y0 g7 a8 f! T
  77.            Button.waitForAnyPress();
    ! O5 w3 g) A4 Q% r- J. d
  78.   }  |4 n$ e6 p" U% C) ~

  79. $ |7 _) P  g. }# b. K# r
  80.   publicstatic void main(String[] args) {6 C9 C8 T( v# ^
  81.            Straighttraveler = new Straight();
    $ b% a/ v4 R7 o8 d7 J4 ~7 b* ]

  82. 4 U0 h! K% B( d' R5 t
  83.            traveler.adjust();
    & P% b: d) |( A. \- }  |: ^
  84.            traveler.go();3 u  S# X+ ^: `( K+ o% ]( Z1 {+ u
  85.   }2 l# Q0 M4 |  x8 J' u+ N; O
  86. }
复制代码
+ q/ [: X3 @. k) q% U! j& ?0 ]  ?
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 编辑 7 B4 w# u$ h$ V

9 o( ~- X+ T+ d7 _: ~* p- B这一行行代码,C?,暂还不懂,反正看到写代码的都敬仰,这种程序是不是比G(乐高是不是叫G语言)的严谨,用代码程序的机器人都能很好的实现复杂功能
如果您觉得我的帖子对您有用,请不吝给我一个“赞”!
回复 赞 踩

使用道具 举报

 楼主| 发表于 2017-7-26 10:08:44 | 显示全部楼层
clx 发表于 2017-7-26 07:22/ v% o3 `- E/ m) y# U
这一行行代码,C?,暂还不懂,反正看到写代码的都敬仰,这种程序是不是比G(乐高是不是叫G语言)的严谨, ...
$ I0 t8 l# Y6 b
我用的是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, 2026-11-17 08:03 , Processed in 0.042576 second(s), 27 queries .

Powered by Discuz! X5.0

© 2001-2026 Discuz! Team.

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