質問編集履歴
1
プログラムを削除しました
test
CHANGED
File without changes
|
test
CHANGED
@@ -9,71 +9,3 @@
|
|
9
9
|
がTeraTermに何も表示されません。
|
10
10
|
|
11
11
|
よろしくお願いします。
|
12
|
-
|
13
|
-
|
14
|
-
|
15
|
-
プログラムは以下のようになっています。
|
16
|
-
|
17
|
-
|
18
|
-
|
19
|
-
#include <SoftwareSerial.h>
|
20
|
-
|
21
|
-
SoftwareSerial mySerial(1,0); //RX,TX
|
22
|
-
|
23
|
-
|
24
|
-
|
25
|
-
/*double t = 0; // 時間の変化*/
|
26
|
-
|
27
|
-
byte sendbuf[9];
|
28
|
-
|
29
|
-
const int txden = 13; // txden はデジタルピン13
|
30
|
-
|
31
|
-
double target = analogRead(A2); // 目標変位
|
32
|
-
|
33
|
-
const double maxAngle = 30; // サーボモータの最大動作角度
|
34
|
-
|
35
|
-
int x = 0;
|
36
|
-
|
37
|
-
|
38
|
-
|
39
|
-
void setup() {
|
40
|
-
|
41
|
-
Serial.begin(115200); // シリアル通信のデータ転送レートは115200bps
|
42
|
-
|
43
|
-
mySerial.begin(9600);
|
44
|
-
|
45
|
-
pinMode(txden, OUTPUT);
|
46
|
-
|
47
|
-
digitalWrite(txden, LOW);
|
48
|
-
|
49
|
-
torque_on(0); // ID0のトルクON
|
50
|
-
|
51
|
-
}
|
52
|
-
|
53
|
-
|
54
|
-
|
55
|
-
void loop() {
|
56
|
-
|
57
|
-
target = analogRead(A2); //変位を読み込む
|
58
|
-
|
59
|
-
double theta0 = constrain(target*2, -maxAngle*100, maxAngle*100); // 目標角度の範囲を目標角度×100から最大角度×100に制限する
|
60
|
-
|
61
|
-
int theta = (int) theta0; // 目標角度を整数型に直す
|
62
|
-
|
63
|
-
sMove(0,9000,0); // パケットの生成及び送信
|
64
|
-
|
65
|
-
delay(10000); // 1[ms]待つ
|
66
|
-
|
67
|
-
sMove(0,-9000,0); //左行く
|
68
|
-
|
69
|
-
delay(10000);
|
70
|
-
|
71
|
-
x = analogRead(A2);
|
72
|
-
|
73
|
-
xref = x / 1024
|
74
|
-
|
75
|
-
mySerial.println(A2);
|
76
|
-
|
77
|
-
delay(1);
|
78
|
-
|
79
|
-
}
|