|
servo_angle
|
Arduino UnoでLiDARの首振りサーボを動かす。D9から角度指令を出し、指令角度・角速度・時刻をUSBシリアルで送る。 [詳解]
#include <Arduino.h>#include <Servo.h>#include <math.h>クラス | |
| struct | ServoState |
| 指定時刻の正弦波サーボ角度と角速度を計算する [詳解] | |
関数 | |
| ServoState | calculate_servo_state (unsigned long timestamp_ms) |
| void | send_data_to_pc (unsigned long timestamp_ms, float angle_deg, float velocity_deg_s) |
| タイムスタンプと角度をシリアル通信でPCへ送信 | |
| void | setup () |
| void | loop () |
変数 | |
| const int | SERVO_PIN = 9 |
| const int | SERVO_UPDATE_INTERVAL_MS = 20 |
| const int | STATE_PUBLISH_FREQ_HZ = 10 |
| const int | STATE_PUBLISH_INTERVAL_MS = 1000 / STATE_PUBLISH_FREQ_HZ |
| const int | MIN_ANGLE_DEG = 70 |
| const int | MAX_ANGLE_DEG = 110 |
| const float | SWEEP_TIME_SEC = 1.0f |
| Servo | servo |
Arduino UnoでLiDARの首振りサーボを動かす。D9から角度指令を出し、指令角度・角速度・時刻をUSBシリアルで送る。
main.cpp に定義があります。
| ServoState calculate_servo_state | ( | unsigned long | timestamp_ms | ) |
| void send_data_to_pc | ( | unsigned long | timestamp_ms, |
| float | angle_deg, | ||
| float | velocity_deg_s ) |
| const int STATE_PUBLISH_INTERVAL_MS = 1000 / STATE_PUBLISH_FREQ_HZ |