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.h@1:2bded5a5f636, 2016-07-02 (annotated)
- Committer:
- sakanakuuun
- Date:
- Sat Jul 02 02:33:24 2016 +0000
- Revision:
- 1:2bded5a5f636
- Child:
- 3:633ea1e7c681
????;
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
sakanakuuun | 1:2bded5a5f636 | 1 | #ifndef Locate_H |
sakanakuuun | 1:2bded5a5f636 | 2 | #define Locate_H |
sakanakuuun | 1:2bded5a5f636 | 3 | |
sakanakuuun | 1:2bded5a5f636 | 4 | |
sakanakuuun | 1:2bded5a5f636 | 5 | #define OUTERRING_D 264 //外輪間距離 |
sakanakuuun | 1:2bded5a5f636 | 6 | #define INNERRING_D 224 //内輪間距離 |
sakanakuuun | 1:2bded5a5f636 | 7 | #define PI 3.14159 |
sakanakuuun | 1:2bded5a5f636 | 8 | #define RESOLUSION 100 //P/R(分解能) |
sakanakuuun | 1:2bded5a5f636 | 9 | #define DIAMETER 50.0 //タイヤの直径 (mm) |
sakanakuuun | 1:2bded5a5f636 | 10 | #define Locate_STEP (DIAMETER*PI / RESOLUSION) // エンコーダの一ステップあたりの距離(mm) |
sakanakuuun | 1:2bded5a5f636 | 11 | #define TIRE_DISTANCE ((OUTERRING_D + INNERRING_D) / 2) //タイヤ間距離(mm) |
sakanakuuun | 1:2bded5a5f636 | 12 | #define ROUND (DIAMETER / (RESOLUSION * TIRE_DISTANCE)) //1回転するためのステップ数の”逆数” |
sakanakuuun | 1:2bded5a5f636 | 13 | |
sakanakuuun | 1:2bded5a5f636 | 14 | //エンコーダから、現在のパルス数を得られるぞ! |
sakanakuuun | 1:2bded5a5f636 | 15 | //真ん中中心で考える! |
sakanakuuun | 1:2bded5a5f636 | 16 | |
sakanakuuun | 1:2bded5a5f636 | 17 | class Locate { |
sakanakuuun | 1:2bded5a5f636 | 18 | private: |
sakanakuuun | 1:2bded5a5f636 | 19 | int v; //ステップ速度 |
sakanakuuun | 1:2bded5a5f636 | 20 | double theta; //機体角度 |
sakanakuuun | 1:2bded5a5f636 | 21 | public: |
sakanakuuun | 1:2bded5a5f636 | 22 | Locate (); |
sakanakuuun | 1:2bded5a5f636 | 23 | |
sakanakuuun | 1:2bded5a5f636 | 24 | double x, y; //機体角度、xy方向に進む距離(m換算なし)(mainに送る) |
sakanakuuun | 1:2bded5a5f636 | 25 | |
sakanakuuun | 1:2bded5a5f636 | 26 | void update (short int, short int); //引数は左右のパルス数でエンコーダから受け取る |
sakanakuuun | 1:2bded5a5f636 | 27 | }; |
sakanakuuun | 1:2bded5a5f636 | 28 | |
sakanakuuun | 1:2bded5a5f636 | 29 | |
sakanakuuun | 1:2bded5a5f636 | 30 | #endif |