RogiStandard-hal
STM32 向けサークル共通ライブラリ
読み取り中…
検索中…
一致する文字列を見つけられません
Servo.hpp
[詳解]
1#pragma once
2#include <cstdint>
3#include "main.h"
4#ifndef HAL_TIM_MODULE_ENABLED
5#error "Servo には TIM が必要です。CubeMX で TIM を有効にしてコードを再生成してください。"
6#endif
7
8class Servo {
9public:
10 // pulseMin/pulseMax は省略可能(デフォルト 600 / 2100)
11 Servo(TIM_HandleTypeDef* htim,
12 uint32_t channel,
13 uint16_t pulseMinUs = 500,
14 uint16_t pulseMaxUs = 2500,
15 bool invert = false,
16 float gear_ratio = 1.0f,
17 uint8_t device_id = 0);
18
19 void begin(float start_ang = 60.0f); // PWM開始+初期位置(90°)
20 void setAngleRange(float minDeg, float maxDeg); // 有効角度範囲
21 // 減速比を設定(>0)。既定値は 1.0(等倍)。
22 void setGearRatio(float ratio = 1.0f);
23 void setAngle(float deg); // 任意角度
24 void setPulse(uint32_t us); // 任意パルス
25
26 // ハンド開閉用
27 void setHandAngles(float openDeg, float closeDeg); // 角度設定
28 void setHand(bool open); // true=10°, false=72°
29 void openHand(); // 10°
30 void closeHand(); // 72°
31
32 // 現在出力中のパルス幅[us](CCR値)を取得
33 uint32_t getPulse() const;
34
35private:
36 uint32_t angleToPulse(float deg) const;
37 static float clamp(float v, float lo, float hi);
38
39 TIM_HandleTypeDef* htim_;
40 uint32_t ch_;
41 uint16_t pulseMin_, pulseMax_;
42 bool invert_;
43 float angleMin_, angleMax_;
44 float gear_ratio_ = 1.0f; // 外部角度→サーボ角度の倍率(減速比)。1.0で等倍。
45 // 事前計算で除算を削減
46 float span_inv_ = 0.0f; // 1/(angleMax-angleMin)
47 float pulse_span_ = 0.0f; // (pulseMax - pulseMin)
48
49 float handOpen_; // 10°
50 float handClose_; // 72°
51 uint8_t device_id_ = 0;
52public:
53 uint8_t deviceID() const { return device_id_; }
54};
Definition Servo.hpp:8
void begin(float start_ang=60.0f)
Definition Servo.cpp:29
void setAngle(float deg)
Definition Servo.cpp:52
void openHand()
Definition Servo.cpp:78
void setGearRatio(float ratio=1.0f)
Definition Servo.cpp:46
void setHandAngles(float openDeg, float closeDeg)
Definition Servo.cpp:66
void setHand(bool open)
Definition Servo.cpp:72
void setPulse(uint32_t us)
Definition Servo.cpp:59
uint8_t deviceID() const
Definition Servo.hpp:53
void closeHand()
Definition Servo.cpp:79
uint32_t getPulse() const
Definition Servo.cpp:107
void setAngleRange(float minDeg, float maxDeg)
Definition Servo.cpp:37