if文を加えたい

Question

Adafruit LIS3DH 3軸加速度センサーモジュールをアルディーノUNOに搭載しセンサーを傾けた時の角度を検出できるようになりました。

次に質問なのですがif文を以下のプログラムに加えたいです。
センサーを傾けた時の角度が50度以下だとLEDが点滅し、50度以上だとLEDが点灯するプログラムにしたいです。

どのようにしたらよいでしょうか？
回答お願いします。

#include <Wire.h>
#include <SPI.h>
#include <Adafruit_LIS3DH.h>
#include <Adafruit_Sensor.h>

// Used for software SPI
#define LIS3DH_CLK 13
#define LIS3DH_MISO 12
#define LIS3DH_MOSI 11
// Used for hardware & software SPI
#define LIS3DH_CS 10

Adafruit_LIS3DH lis = Adafruit_LIS3DH(LIS3DH_CS, LIS3DH_MOSI, LIS3DH_MISO, LIS3DH_CLK);

#if defined(ARDUINO_ARCH_SAMD)
#define Serial SerialUSB
#endif

void setup(void) {
#ifndef ESP8266
while (!Serial);
#endif

Serial.begin(9600);
Serial.println("LIS3DH test!");

if (! lis.begin(0x18)) {
Serial.println("Couldnt start");
while (1);
}
Serial.println("LIS3DH found!");

lis.setRange(LIS3DH_RANGE_4_G);

Serial.print("Range = "); Serial.print(2 << lis.getRange());
Serial.println("G");
}

void loop() {
lis.read();
// Then print out the raw data
Serial.print("X: "); Serial.print(lis.x);
Serial.print(" \tY: "); Serial.print(lis.y);
Serial.print(" \tZ: "); Serial.print(lis.z);

sensors_event_t event;
lis.getEvent(&event);

Serial.print("\t\tX: "); Serial.print(event.acceleration.x);
Serial.print(" \tY: "); Serial.print(event.acceleration.y);
Serial.print(" \tZ: "); Serial.print(event.acceleration.z);
Serial.println(" m/s^2 ");

Serial.println();

delay(200);
}

Comments

[ozwk]

>「角速度は観れるようになった」 加速度ではなく?

[ozwk]

角度って何の何に対する角度ですか?

[ozwk]

>「角度を検出できるようになりました。」 コードに反映されてませんが?

[msyk23p2]

シリアルモニターでは検出出来ていると思うのですが、、、

[ozwk]

出力しているの加速度ですよね?

[msyk23p2]

はい。加速度の隣に角度が出ていると思うのですが、、、

[ozwk]

それコードで言うとどこですか?

[msyk23p2]

すみません。まだ使い始めたばかりでコードがどこにあるのか理解していません。acceldemoというライブラリをダウンロードして作ったものです。

[ozwk]

ひょっとして+-9.8ぐらいの範囲で変化する値のこと言ってます？

[ikedas]

コードの出所を明記して下さい (URLなど)。それと、前の質問は解決したということですよね? 解決した質問はちゃんと終了させて下さい (他のサイトでの質問も含めて)。

Answer 1

ご質問のコードは、Adafruit LIS3DHの製品情報サイトの「Adafruit LIS3DH Triple-Axis Accelerometer Breakout」にある「Wiring & Test」からダウンロードできるものですね。

今回はたまたまこういった情報を見つけることができましたが、回答者はエスパーではありません。ご質問なさるのなら、人にわかるように書いてください。

---

まず、この製品が何をするものなのか理解して下さい。説明を読んでみると「triple-axis accelerometer」(3軸加速度計) だと書いてあります。「角度」を直接測るものではありません。

ここまでは理解できますか? 理解できないのなら、上記のサイトの説明を全て読んで、理解して下さい。それから以下の回答を読んで下さい。

回答

出力されるx、y、zは、センサが検出した重力加速度のそれぞれx、y、z成分ですね。センサのz軸の鉛直方向に対する傾きをθとすると、

cos(θ) = -z / sqrt(x^2 + y^2 + z^2)

です (sqrtは平方根。また鉛直方向は上向きを正とする)。図を書いて確認してみて下さい。

従って50°以上の傾きになる条件は

-z / sqrt(x^2 + y^2 + z^2) <= cos(50°)

と書けます。

なお、z > 0の場合 (90°を超えて傾く場合。ひっくり返っている場合と言ったほうがいいですが) を考えないのなら、両辺を2乗して整理して

z^2 <= cos(50°)^2 * (x^2 + y^2 + z^2)

というふうにもできますね。

上記の式をプログラミング言語で表すのは、自分でやって下さい。

Answer 2

こんにちは。

編集↓↓↓↓↓
#####以下のソースは角度取得が誤り

lis.xやlis.y、lis.zにセンサーを傾けた値が入ってると見受けられます。

従って、Serial.printの後にでも、

if(lis.x >= 50){
    digitalWrite(2,HIGH);
}else if(lis.x > 50){
    digitalWrite(2,LOW);
}

---

↑↑↑は誤りでした。角度の取得は上の方の回答の通りです

等とすればよいと思います。
尚、digitalWrite関数の第一引数は、LEDを接続しているピンの番号で、
第二引数は、そのピンの電圧です。
しかし、このままでは、LEDが点灯はしますが、点滅はしません。
また、当然ですが、電流制限用の抵抗は入れてくださいね。

点滅させたいのであれば、タイマー割込みを使うか、millisなどを使うことになるでしょう

例えばですが上述の代わりに、

---

####こちらも角度の取得が誤っています。
点滅のほうは動くと思いますが

if(lis.x >= 50){
    if(millis()％1000 < 500)
        digitalWrite(2,HIGH);
    }else{
        digitalWrite(2,LOW);
    }
}else if(lis.x > 50){
    digitalWrite(2,LOW);
}

---

↑↑↑↑↑
こんなところでしょうか。
millis()%1000の、1000は1000ms(ミリ秒)なので、1周期1秒の点滅をします。値を小さくすれば早い点滅になります。
< 500のところは、LEDがONの時間です。500msなので、ちょうど1秒の半分ですね。小さくすればLEDの点の時間が短くなり滅の時間が長くなります。

おなじ目的の動作でもいろいろな書き方ができるのでぜひお試しを

---

最後に…
細かいことですが、、、
プログラムソースは、Markdown形式で入力した方が見やすくなります。

#include<Wire.h>

等が、大きな文字になっているのは、シャープが「見出し」と認識されているからです、