|
|
本帖最後由 Shiichi 於 2016-3-3 14:02 編輯 * i! O3 ^! L2 D2 O1 j" C7 X
$ D5 Q/ D# j3 t5 j) B您好,不知是否能向您請教。
7 T7 z V2 D) V9 H- W8 [( o目前和宋修賢老師在處理Ardui Car
" k# L4 b, w. m; X雖然已使用較繁雜的方式處理了跑出黑線外的狀況* C D7 v* c. W
$ X/ i4 k" |0 d" s% @
但基於想追求更精簡的程式所以還是想請問一下
- P0 Y4 j! {3 L6 I+ \7 E. L- y就是如果我只以單純寫PID控制時,常遇到CNY70跑出黑線外後便往前衝
' u% ?' K6 Q$ u$ D# M8 i# z不知道您是否願意教我可以如何處理
1 o) O! z0 A0 C+ V f7 ], p$ f5 [) q! ^- @; |% J1 z" |# I$ w( {
: D8 _/ K2 w7 U, P8 W; o/ Z0 D) l以下是我挑出我一般寫純PID控制的Code:- int MotoSpeed = 250;% E5 m7 Q1 z% N! @8 n0 P, `# k: v
- double CNY70Val = 1000;5 e1 v6 ]! w- [3 _, Z8 T& c
- int interror = 0;% p" ~. g7 b% c. J9 d
- int olderror = 0;& N! |! ]; }0 A9 p$ D3 E9 o( u
- double values;/ W& m/ H: o, F
+ R7 o5 \6 S9 B3 p3 x
- k0 y- G( N8 z- D: K- void CNY70()
# V/ A9 p+ U: s' ]( K$ q& W - {
7 L& a. U, Z0 U. v/ A; { - valuesRR = analogRead(RR)
! y. B3 x# k: m - valuesMR = analogRead(MR);
& [/ A1 y6 B& E2 w! ?) |7 r0 a - valuesMM = analogRead(MM);& Z, D4 z% P9 p3 i1 o( g$ T! V& b
- valuesML = analogRead(ML);8 j! |$ K) _8 n
- valuesLL = analogRead(LL);- B7 Y3 G# ^( t' a. N8 Q! b; ^6 e
- , }$ i1 Q$ {+ h0 t/ R
- if (valuesRR > CNY70Val)7 H5 u7 R# _" a8 V1 s
- valuesRR = CNY70Val;
+ F' w2 k; @, V4 P- h4 i7 P - if (valuesMR > CNY70Val)
. {7 I& w: r$ |/ h1 I* p! V - valuesMR = CNY70Val;
1 ^2 Z4 N, k* N) r' C' q1 `4 { - if (valuesMM > CNY70Val)
7 H" [% \- {5 [+ [ - valuesMM = CNY70Val;
7 F0 p* I: \# t - if (valuesML > CNY70Val)
' d* a3 ^' G* ^6 J! A+ A- d - valuesML = CNY70Val;: ?/ `: `& x% O F5 M: a7 d. Z; I
- if (valuesLL > CNY70Val)* u1 E5 A3 l8 m" }% g4 }: L9 s
- valuesLL = CNY70Val;8 y Z0 _5 B8 n4 k! L( _7 U
- . o, M; n0 x1 h# @* w
- values = valuesLL * -1 + valuesML * -0.5 + valuesMM * 0 + valuesMR * 0.5 valuesRR * 1;. ?7 s8 w7 p, j! H# c, }
- }
& O! N& l0 @& x P
P6 d3 b. a. [! D( \- void Car(): c( i& s$ ^: K
- {6 W5 F- {2 u& z( a d E! @3 T
- while (1) {) [: B/ H9 n; B, b
- CNY70();! ~( G8 c; j: ]3 t
& f2 u: g" i+ K, V, x- int error = ((int)values);" K; G% o0 v3 {3 D
- interror += error;$ F4 d3 t4 g# k; M( Q$ V1 u2 o7 B
- int lasterror = error - olderror;+ _3 s, Q9 I. ?4 }) H
- olderror = error;
9 V0 r. F @; a( y8 w: U/ w9 U4 ?' a - int power = error / 5 + interror / 10000 + lasterror;
c+ Y R% }0 U- q, C+ N
* Y2 W, x! @6 c* i- ], B3 \" S( P- if (power > MotoSpeed)# R; l4 \: A8 j; l# s
- power = MotoSpeed;
( R: g4 T) c: }2 T - if (power < -MotoSpeed)
3 y# P9 l7 }( G- p' c - power = -MotoSpeed;! z, T% j. `% c* P7 U7 Z
- 0 ~5 d6 Q" R* s9 U% U: a
- if (power > 0)& T) Z1 m% A' s+ E, E3 a' r% q
- Speed(MotoSpeed, MotoSpeed - power); //馬達動作,正數正轉 負數反轉。
% T. J) o1 v5 B/ u9 u - else5 C, f) B3 a2 g* j& n4 g' _4 a
- Speed(MotoSpeed + power, MotoSpeed);! m( O& l' n0 d$ j& ^3 G( |) m
- }
$ [- ^' F8 \$ m# R - }
複製代碼 . o+ s' N9 b5 a
, h& b B& L: ^ |
|