質問編集履歴
2
削除された内容の復元を行いました
title
CHANGED
|
File without changes
|
body
CHANGED
|
@@ -1,1 +1,24 @@
|
|
|
1
|
-
以下のプログラムを作成したのですがーが動きません。で角度を求めてその位置まで動いて元の位置に戻るプログラムを作りたいです。どこように改善したらよいでしょうか？回答お願いします。
|
|
1
|
+
以下のプログラムを作成したのですがサーボモーターが動きません。逆運動学で角度を求めてその位置まで動いて元の位置に戻るプログラムを作りたいです。どこように改善したらよいでしょうか？回答お願いします。
|
|
2
|
+
#include<stdio.h>
|
|
3
|
+
#include<math.h>
|
|
4
|
+
#include<Servo.h>
|
|
5
|
+
Servo servo;
|
|
6
|
+
int A=0;
|
|
7
|
+
void setup(){
|
|
8
|
+
|
|
9
|
+
servo.attach(9);
|
|
10
|
+
double a,b,c.A;
|
|
11
|
+
a=10;
|
|
12
|
+
b=20;
|
|
13
|
+
c=30;
|
|
14
|
+
|
|
15
|
+
A=acos((b*b+c*c-a*a)/2*b*c);
|
|
16
|
+
degree = A*180.0/PI;
|
|
17
|
+
}
|
|
18
|
+
void loop()
|
|
19
|
+
{
|
|
20
|
+
servo.write(A);
|
|
21
|
+
delay(1000);
|
|
22
|
+
servo.write(0);
|
|
23
|
+
delay(1000);
|
|
24
|
+
}
|
1
title
CHANGED
|
File without changes
|
body
CHANGED
|
@@ -1,28 +1,1 @@
|
|
|
1
|
-
以下のプログラムを作成したのですが
|
|
1
|
+
以下のプログラムを作成したのですがーが動きません。で角度を求めてその位置まで動いて元の位置に戻るプログラムを作りたいです。どこように改善したらよいでしょうか？回答お願いします。
|
|
2
|
-
|
|
3
|
-
#include<stdio.h>
|
|
4
|
-
#include<math.h>
|
|
5
|
-
#include<Servo.h>
|
|
6
|
-
Servo servo;
|
|
7
|
-
|
|
8
|
-
int A=0;
|
|
9
|
-
|
|
10
|
-
void setup(){
|
|
11
|
-
|
|
12
|
-
servo.attach(9);
|
|
13
|
-
double a,b,c.A;
|
|
14
|
-
a=10;
|
|
15
|
-
b=20;
|
|
16
|
-
c=30;
|
|
17
|
-
|
|
18
|
-
|
|
19
|
-
A=acos((b*b+c*c-a*a)/2*b*c);
|
|
20
|
-
degree = A*180.0/PI;
|
|
21
|
-
}
|
|
22
|
-
void loop()
|
|
23
|
-
{
|
|
24
|
-
servo.write(A);
|
|
25
|
-
delay(1000);
|
|
26
|
-
servo.write(0);
|
|
27
|
-
delay(1000);
|
|
28
|
-
}
|