for f3rc

Fork of Encoder by Tk A

使い方

まず、"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();

となる

Committer:
sakanakuuun
Date:
Sat Jul 02 02:33:24 2016 +0000
Revision:
1:2bded5a5f636
Child:
3:633ea1e7c681
????;

Who changed what in which revision?

UserRevisionLine numberNew 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