找回密码
 马上注册

QQ登录

只需一步,快速开始

查看: 13442|回复: 7

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

[复制链接]
发表于 2017-7-25 22:09:23 | 显示全部楼层 |阅读模式
本帖最后由 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
然后上源代码:
  1. 5 ^+ |1 r) g4 e) L! ~
  2. importlejos.robotics.navigation.DifferentialPilot;
    ( r6 T, C# F9 O/ Q' |3 g
  3. import lejos.util.Delay;2 x" f) r4 J& `- |8 Y  e" B
  4. 0 j: M3 Z; ~' a+ _) h/ x" n1 J
  5. /**
    % \5 ?8 G' o4 V
  6. *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
  7. */6 \: j- G( V8 R" k2 n

  8. 3 M) w4 l/ `9 }4 Z! {) k; p

  9. 3 M0 h& x( y9 A* |0 z& ^& w& q: U
  10. public class Straight {. X! t2 A. C' f% p& a# b
  11.   DifferentialPilotpilot;
    " k$ L, Q) ^' j# K, n& I( G
  12.   doubleleftD = 4.3, rightD = 4.3;$ x9 f  l: I% c" q+ k9 S

  13. 9 [/ o& B3 l& u( G, F' C) p  n
  14.   publicvoid adjust() {  Z8 Q2 w1 n) p6 _7 d, ]+ Y
  15.            //wait for release( y1 `3 V1 P; u; S$ t$ T( ~& x0 {+ v
  16.            while(Button.readButtons() > 0)
    ) j( G( |* H, e# a* g8 W* S# |5 O
  17.                    ;
    5 F4 {+ c" T: b5 ~7 l
  18.            while(Button.readButtons() == 0) {
    ) k7 t" g/ Y7 H, I# H1 l
  19.                    //input size by adjusting the wheels9 \6 o# Z0 O+ }1 C$ h: T+ y/ @! A
  20.                    rightD= (double) (Motor.A.getTachoCount()) / 2160 + 4.3;, Q3 Q4 Q; `4 T5 U
  21.                    leftD= (double) (Motor.B.getTachoCount()) / 2160 + 4.3148;// 调试所得值
    $ \2 p# [2 ^$ f" {0 J1 D' f
  22. + M  F3 w7 @. l  A  c! z6 Z+ C4 {, J
  23.                    //display the size input& m: o, y  {5 }8 e
  24.                    LCD.drawString("L:"+ String.valueOf(leftD), 0, 0);6 ~. p2 s# _9 _
  25.                    LCD.drawString("R:"+ String.valueOf(rightD), 0, 1);
    : d  a( q/ M) O  U
  26.                    Delay.msDelay(100);
    . o, R6 m# `8 D
  27.                    LCD.clear();
    + t  N$ `8 u8 I' j" T+ F1 t: c
  28.            }
    . q/ Z5 x; d9 z; N4 W
  29. 7 k) f5 ]2 [# t0 Z4 `  D
  30.   }/ L" A; V- o" j0 V- S
  31. * _7 K' P+ O! V. g3 d6 G
  32.   publicvoid go() {: @8 O) q0 I( x9 f
  33.            //准备起步$ C6 p* p8 {) |/ H7 U! i2 r5 F
  34.            //wait for release3 K) Y4 a7 ]( m( O1 N
  35.            while(Button.readButtons() > 0)/ B7 g4 O5 ?! ~# \* u& k: p2 @: O- y
  36.                    ;
    + Q: x2 F: _5 c( s
  37.            System.out.println("pressto go");
    % U, B) ~0 z9 c, u: z

  38. 8 p0 u5 ]1 b: R4 U1 Q2 I
  39.            Button.waitForAnyPress();6 c% c- w0 ~9 g5 o- T% c3 H
  40.            LCD.clear();
    5 v' W7 ?3 M5 y9 [
  41. & V: m# i  P7 c1 P
  42.            //初始化0 d- H& ?: I1 Z8 J5 X# D
  43.            pilot= new DifferentialPilot(rightD, leftD, 13.5, Motor.A, Motor.B, true);4 X7 u' ]3 q- \
  44.            pilot.reset();5 f# y9 t6 U( h, |

  45. 4 a+ |0 m. b1 K) }2 B2 E
  46.            Delay.msDelay(3000);
    , i* i# _8 z& K
  47. 6 }" i0 p% C# }1 A+ R5 t5 G$ F
  48.            doublespeed = 10;
    & h" F5 B3 a6 m! o' z4 v
  49.            doubledistance = 0;5 g0 I4 f! S9 m

  50. 9 l0 J) v; Z7 K, g
  51.            //起步加速
    $ O3 t$ N  M% r: p/ I0 K
  52.            pilot.travel(300,true);
    - E- Z/ w! n3 B- ^  n+ v; C" H

  53. # ^; ]' Z! s0 M7 T0 ]
  54.            while(distance < 20) {# [8 W, g( F7 t  N4 K& c# T# G
  55.                    distance= pilot.getMovement().getDistanceTraveled();
    . A4 c! }* ~; c3 Q$ d
  56.                    speed= distance * 5 + 10;) X6 i) E! r8 _# |7 z* o
  57.                    pilot.setRotateSpeed(speed);
    ( i+ H# K" w' W# {
  58.                    Delay.msDelay(100);
    2 _- k6 i0 [0 S" ^
  59.            }7 i+ e; Y  {* c3 m
  60.            for(int i = 0; i < 10; i++) {
    4 W/ L. j6 T+ |8 o  R
  61.                    speed+= 5;' f! {- L2 w7 P: c
  62.                    pilot.setRotateSpeed(speed);
    ; a. d) A  N; \4 q5 ?
  63.                    Delay.msDelay(200);
    / B5 D1 A) h+ ?6 \
  64.            }
      R' y1 c% |- ^; u* a5 u

  65. % E  I1 ~! {) o+ _4 z
  66.            //TODO 减速, R& f1 g, V  `% B7 J3 E
  67. 4 b% L% T' {; ?# d) N, {
  68.            //停止机能
    ; M4 \/ ?) u' |1 G
  69.            while(pilot.isMoving()) {" y0 Q& [4 ?, d2 i  X$ l
  70.                    if(Button.readButtons() > 0)( b9 O6 O% O/ ]3 m
  71.                            pilot.stop();
    % j  |7 ?8 f% t5 p5 S& g2 O, j  O
  72.            }
    5 r0 z( ^  u6 x$ u5 f

  73. " k, e& F& k. e6 t% [" P4 h  r- i: u: M
  74.            System.out.println("" + pilot.getMovement().getDistanceTraveled());! v" t+ {2 l' O& g) ?+ O
  75.            System.out.println(-Motor.A.getTachoCount());  F4 f1 f+ C! N) o
  76.            System.out.println(-Motor.B.getTachoCount());( U/ G9 R1 W( q: }" f: F' H! r5 q
  77.            Button.waitForAnyPress();
    0 Y7 f* s- ?8 J  r: \! N% m
  78.   }9 C; }3 t2 F) l3 {1 V4 C& B1 T

  79. . l0 z. `9 g) P. [! J9 q
  80.   publicstatic void main(String[] args) {" V, l' |( b6 S( p7 _9 ^; `
  81.            Straighttraveler = new Straight();
    ) I+ D) ^* ?0 ]4 v
  82.   O' I' i: e* J
  83.            traveler.adjust();
    % ~1 D, u+ J# Z/ R5 d
  84.            traveler.go();
    2 b. [+ G: E& h
  85.   }. H# R% f! ]/ J( P) a4 ^
  86. }
复制代码

' j4 B1 y7 k* P( g; ~) Q* F3 W
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 编辑 0 m" c2 x* Y  [3 z
& q/ y8 R# [  I0 s6 ?( D! Y
这一行行代码,C?,暂还不懂,反正看到写代码的都敬仰,这种程序是不是比G(乐高是不是叫G语言)的严谨,用代码程序的机器人都能很好的实现复杂功能
如果您觉得我的帖子对您有用,请不吝给我一个“赞”!
回复 赞 踩

使用道具 举报

 楼主| 发表于 2017-7-26 10:08:44 | 显示全部楼层
clx 发表于 2017-7-26 07:22
% B/ B5 A# A0 x& N3 z1 q8 T8 m这一行行代码,C?,暂还不懂,反正看到写代码的都敬仰,这种程序是不是比G(乐高是不是叫G语言)的严谨, ...

/ o& p# y% q, b4 `$ S4 C0 H我用的是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-20 09:00 , Processed in 0.041537 second(s), 26 queries .

Powered by Discuz! X5.0

© 2001-2026 Discuz! Team.

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