プログラム

Question

元の座標地から目的の座標地までをサーボモーターで交互に繰り返し動くプログラムを作りたいのですが上手く動きません。改善点などありましたら教えてほしいです！

#include<stdio.h>
#include<math.h>
#include<Servo.h>
Servo servo1,servo2;
double a,b,c,x,y,pos1,pos2,pos3,pos4,pos5,A,B,C,D,radian1,radian2;
void setup(){
servo1.attach(9);
servo2.attach(7);
y=5;
b=5;
c=5;

}
void loop(){

for ( x = -5; x < 5; x += 1 ) {
a=sqrt(xx+yy);
pos1=((bb+cc-aa)/(2bc));
radian1=acos(pos1);
A=radian1180/M_PI;//M_PI（円周率）
B=180-A;//二個目のモーターの角度
pos2=(y/x);
pos5=((bb+aa-cc)/(2ba));
D=acos(pos5);
radian2=atan(pos2);
C=radian2180/M_PI-D;//一つ目のモーターの角度
servo1.write(C);
delay(1000);
servo2.write(B);
delay(1000);
}
for ( x = 5; x > -5; x -= 1 ) {

a=sqrt(xx+yy);
pos1=((bb+cc-aa)/(2bc));
radian1=acos(pos1);
A=radian1180/M_PI;//M_PI（円周率）
B=180-A;//二個目のモーターの角度
pos2=(y/x);
pos5=((bb+aa-cc)/(2ba));
D=acos(pos5);
radian2=atan(pos2);
C=radian2180/M_PI-D;//一つ目のモーターの角度
servo1.write(C);
delay(1000);
servo2.write(B);
delay(1000);
}
}

Comments

[jm1156]

こちらの質問と内容がかぶっているように思うのですが、解決しましたか？　https://teratail.com/questions/51032　これ以外にも過去に質問されたまま解決されていない案件がありますが、そちらは解決できているのでしょうか？　変数が何を表しているのかわからないし、「うまく動かない」というのがどういう状況なのかわかりません。現状、どういう風になっていて、どうしたいのか？をもっと詳しく書いてください。