for f3rc
Fork of Encoder by
使い方
まず、"Locate.h"をインクルードする。 次に、Locate machine(x, y)で宣言する。(xとyは初期位置。でも(0,0)推奨) 続いて位置情報を得る。 位置情報を更新する関数は、machine.update()だが、位置情報を得る方法は2つある
(1)machine.update()を直接使う場合
一連の処理は、
machine.update((エンコーダの右), (エンコーダの左));
x = machine.getX();
y = machine.getY();
こんな感じ。
(2)machine.update()を直接使わない場合
一連の処理は、
x = machine.getX((エンコーダの右), (エンコーダの左));
y = machine.getY((エンコーダの右), (エンコーダの左));
こんな感じ。 あるいは、
x = machine.getX((エンコーダの右), (エンコーダの左));
y = machine.getY();
でも同じ結果を得られる。
まとめると、位置情報を得るときは、最初の関数にエンコーダで読み取った値を渡す必要がある。
ちなみにエンコーダの値を得るためには、"QEI.h"(https://developer.mbed.org/users/aberk/code/QEI/) を別途インクルードしたうえで、
QEI right (PA_7, PA_5, NC, lPR, QEI::X2_ENCODING); 右側のエンコーダ
QEI left (PA_13, PA_15, NC, lPR, QEI::X2_ENCODING); 左側のエンコーダ
のように宣言する必要がある。 その後、例えば右側のエンコーダの値を得たいときには、right.getPulses() を使う これを使うと、(1)は
machine.update(right.getPulses(), left.getPulses());
x = machine.getX();
y = machine.getX();
となる
Locate.cpp@7:d4fcddd78fce, 2016-08-11 (annotated)
- Committer:
- sakanakuuun
- Date:
- Thu Aug 11 05:43:48 2016 +0000
- Revision:
- 7:d4fcddd78fce
- Parent:
- 6:835fbc52feb0
- Child:
- 8:a5093de00347
?????
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
sakanakuuun | 3:633ea1e7c681 | 1 | #include <math.h> |
sakanakuuun | 1:2bded5a5f636 | 2 | #include "Locate.h" |
sakanakuuun | 1:2bded5a5f636 | 3 | |
sakanakuuun | 1:2bded5a5f636 | 4 | |
sakanakuuun | 3:633ea1e7c681 | 5 | Locate::Locate (int fx, int fy) |
sakanakuuun | 3:633ea1e7c681 | 6 | { |
sakanakuuun | 3:633ea1e7c681 | 7 | x = fx; |
sakanakuuun | 3:633ea1e7c681 | 8 | y = fy; |
sakanakuuun | 7:d4fcddd78fce | 9 | |
sakanakuuun | 7:d4fcddd78fce | 10 | //一応全て初期化しとく |
sakanakuuun | 7:d4fcddd78fce | 11 | dr = 0; dl = 0; |
sakanakuuun | 7:d4fcddd78fce | 12 | pr = 0; pl = 0; |
sakanakuuun | 7:d4fcddd78fce | 13 | rad = 0; |
sakanakuuun | 7:d4fcddd78fce | 14 | v = 0; |
sakanakuuun | 3:633ea1e7c681 | 15 | } |
sakanakuuun | 3:633ea1e7c681 | 16 | |
sakanakuuun | 3:633ea1e7c681 | 17 | void Locate::setup(int r, int l) |
sakanakuuun | 3:633ea1e7c681 | 18 | { |
sakanakuuun | 3:633ea1e7c681 | 19 | pr = dr = r; //(今(最初)のステップ数) = (初期ズレ) = (エンコーダから受け取るステップ数) |
sakanakuuun | 3:633ea1e7c681 | 20 | pl = dl = l; //上の説明は意味不明なので無視してください |
sakanakuuun | 1:2bded5a5f636 | 21 | } |
sakanakuuun | 1:2bded5a5f636 | 22 | |
sakanakuuun | 1:2bded5a5f636 | 23 | |
sakanakuuun | 3:633ea1e7c681 | 24 | void Locate::update (int r, int l) |
sakanakuuun | 3:633ea1e7c681 | 25 | { |
sakanakuuun | 3:633ea1e7c681 | 26 | r -= dr; l -= dl; //ズレを修正 |
sakanakuuun | 3:633ea1e7c681 | 27 | |
sakanakuuun | 6:835fbc52feb0 | 28 | rad = (r - l) * ROUND; |
sakanakuuun | 3:633ea1e7c681 | 29 | v = (r-pr + l-pl) / 2; //r-pr = 前回から右車輪が進んだステップ数 |
sakanakuuun | 3:633ea1e7c681 | 30 | |
sakanakuuun | 6:835fbc52feb0 | 31 | x += v * (cos(rad)); |
sakanakuuun | 6:835fbc52feb0 | 32 | y += v * (sin(rad)); |
sakanakuuun | 3:633ea1e7c681 | 33 | |
sakanakuuun | 3:633ea1e7c681 | 34 | pr = r; //今回のステップ数を保存 |
sakanakuuun | 3:633ea1e7c681 | 35 | pl = l; |
sakanakuuun | 3:633ea1e7c681 | 36 | } |
sakanakuuun | 3:633ea1e7c681 | 37 | |
sakanakuuun | 3:633ea1e7c681 | 38 | |
sakanakuuun | 3:633ea1e7c681 | 39 | short Locate::getX() |
sakanakuuun | 3:633ea1e7c681 | 40 | { |
sakanakuuun | 3:633ea1e7c681 | 41 | return x * LOCATE_STEP; |
sakanakuuun | 3:633ea1e7c681 | 42 | } |
sakanakuuun | 3:633ea1e7c681 | 43 | |
sakanakuuun | 3:633ea1e7c681 | 44 | short Locate::getY() |
sakanakuuun | 3:633ea1e7c681 | 45 | { |
sakanakuuun | 3:633ea1e7c681 | 46 | return y * LOCATE_STEP; |
sakanakuuun | 1:2bded5a5f636 | 47 | } |