加速度センサーを用いたBluetoothでのモータ制御ができない

Question

#やろうとしていること
今、Arudinoを用いて加速度センサーとbluetoothモジュール(RN42評価キット)を繋げ(外部電源)、パソコンのbluetoothを介して加速度センサーでサーブモーターを制御しようとしています。

そこでプログラミングについての質問なのですが

#「加速度センサーとbluetoothモジュール側」
include <Servo.h>

int BTReset = 3;
Servo myservoX;
Servo myservoY;
void setup()
{

digitalWrite(BTReset, LOW);
delay(100);
digitalWrite(BTReset, HIGH);
delay(500);
// シリアルモニターの初期化をする
Serial.begin(115200) ;
myservoX.attach( 5 );
myservoY.attach( 6 );
}

void loop()
{
int i ;
long x , y;
// 各データを100回読み込んで平均化する
x = y = 0 ;
for (i=0 ; i < 100 ; i++) {
x = x + analogRead(3) ; // Ｘ軸を読み込む
y = y + analogRead(4) ; // Ｙ軸を読み込む
}
x = x / 100 ;
y = y / 100 ;
int rotateX = (x-198)/7.8888; //角度を求める式
Serial.print("X:") ;
Serial.print(x) ;
Serial.print(" ") ;
Serial.print(rotateX) ;

int rotateY = (y-220)/7.02;
myservoY.write( 90-rotateY );
Serial.print(" Y:") ;
Serial.print(y) ; // Y軸
Serial.print(" ") ;
Serial.println(rotateY) ; // Y軸
delay(10) ;
}

#「サーブモータ側」
include <Servo.h>

Servo myservoX;
Servo myservoY;
void setup()
{
// シリアルモニターの初期化をする
Serial.begin(115200) ;
myservoX.attach( 5 );
myservoY.attach( 6 );
}
void loop()
{
int i ;
long x , y;
// 各データを100回読み込んで平均化する
x = y = 0 ;
for (i=0 ; i < 100 ; i++) {
x = x + analogRead(3) ; // Ｘ軸を読み込む
y = y + analogRead(4) ; // Ｙ軸を読み込む
}
x = x / 100 ;
y = y / 100 ;
int rotateX = (x-198)/7.8888; //角度を求める式
Serial.print("X:") ;
Serial.print(x) ;
Serial.print(" ") ;
Serial.print(rotateX) ;
int rotateY = (y-220)/7.02;
myservoY.write( 90-rotateY );
Serial.print(" Y:") ;
Serial.print(y) ; // Y軸
Serial.print(" ") ;
Serial.println(rotateY) ; // Y軸
delay(10) ;
}

以上のプログラミングで試したら、加速度センサーでのシリアルモニターが止まったりし、全くモーターが動かないのですが、どこを直したらいいかよくわかりません…
わかる方がいたらぜひ教えて頂きたいです！
よろしくお願いいたします。

Answer 1

失礼ながら、何を作ったのか、と言わざるを得ません。
だって、そのサー'ボ'モーターの方にデータを受信する処理がどこにもないのだもの...

簡単・単純なものから順にステップアップしないと、いきなり2台のArduinoで数値データのやり取りなんてのはキツいと思いますよ。
まずは1台で加速度センサーを読み取り、サーボを動かし、PCとの間でシリアルを送信し、あるいは受信し、それぞれが出来るようになったら組み合わせて、それから2台に発展、とかの手順を踏みましょう。

Comments

[nakajii]

回答ありがとうございます
まずは順々にステップを踏んでから、２台の通信に取り組みます！

Answer 2

サーボモータ側の

// 各データを100回読み込んで平均化する
x = y = 0 ;
for (i=0 ; i < 100 ; i++) {
x = x + analogRead(3) ; // Ｘ軸を読み込む
y = y + analogRead(4) ; // Ｙ軸を読み込む
}

ってなにやってるの？

Comments

[nakajii]

とりあえず、動かないので加速度センサー側と同じコードを入れてみました！
やはり、無意味でしょうか？

[y_waiwai]

なんぢゃそりゃｗ
うごくわけないじゃんｗ

[y_waiwai]

んで、加速度センサの値はちゃんとPCにいってるの？ｗ

[nakajii]

現状としては、外部電源に切り替えた、加速度センサーの値はbluetoothを介して無事にパソコン側に送られています！
しかし、パソコンと繋げたモーター側をどうしたらいいかわからなくて…

[y_waiwai]

(Arduino1)加速度センサ->Bluetooth --> PC --> (Alduino2)Bluetooth->サーボモータ
Arduinoの基板を２つ使ってこういう構成でやってんだよね？

[nakajii]

まさにそゆう構成でやっています！
arudino(uno)を二つ使っています！

[nakajii]

パソコンのbluetoothで受信して、サーボモーターが繋がったarudino2と通信しているかんじになります！

[y_waiwai]

なら次に、PCからなんかターミナルソフト（Teratermかなんか）でも使って、モータを動かす電文送ってそのとおりモータ回るのを確認すること。

[y_waiwai]

Bluetoothが怪しかったら、シリアル直接つないで確認すれｗ

[nakajii]

モーターの動作は確認できました！

[nakajii]

プログラミングがどうやったらいまいちわからないです…

[y_waiwai]

なら双方つないで動作確認。
これでだめと言うなら、センサ側の通信とモータ側の通信をPCの画面に出すようなソフトでも組んでデバッグやなー

[nakajii]

#include <Servo.h>

Servo myservoX;
Servo myservoY;
void setup()
{
// シリアルモニターの初期化をする
Serial.begin(115200) ;
myservoX.attach( 5 );
myservoY.attach( 6 );
}

void loop(){

}

サーボのほうはこのようにしたのですが、どうでしょうか？

[y_waiwai]

loopの中身なんもないぢゃんｗ
PCから通信受けてモータ動かすコード組むんでしょ。がんばれｗ

[nakajii]

頑張ります！！！