mirs_esp_pio
読み取り中…
検索中…
一致する文字列を見つけられません
DiffMotors.cpp
[詳解]
1#include "DiffMotors.hpp"
2
4 bool left_reversed, bool right_reversed)
5 : left_(left)
6 , right_(right)
7 , left_reversed_(left_reversed)
8 , right_reversed_(right_reversed)
9{
10}
11
12void DiffMotors::begin(uint32_t pwm_freq, uint8_t pwm_resolution) {
13 left_.begin(pwm_freq, pwm_resolution);
14 right_.begin(pwm_freq, pwm_resolution);
15}
16
17void DiffMotors::setReversed(bool left_reversed, bool right_reversed) {
18 left_reversed_ = left_reversed;
19 right_reversed_ = right_reversed;
20}
21
22namespace {
23// 四捨五入(切捨てでは微小dutyが消失する。MotorDriver側で±255にclampされる)
24int roundDuty(double duty) {
25 const int truncated = static_cast<int>(duty);
26 const double frac = duty - truncated;
27 if (frac >= 0.5) {
28 return truncated + 1;
29 }
30 if (frac <= -0.5) {
31 return truncated - 1;
32 }
33 return truncated;
34}
35} // namespace
36
37void DiffMotors::setLeft(double duty) {
38 left_.setDuty(roundDuty(left_reversed_ ? -duty : duty));
39}
40
41void DiffMotors::setRight(double duty) {
42 right_.setDuty(roundDuty(right_reversed_ ? -duty : duty));
43}
44
45void DiffMotors::setBoth(double duty_left, double duty_right) {
46 setLeft(duty_left);
47 setRight(duty_right);
48}
49
51 left_.stop();
52 right_.stop();
53}
左右モータの出力をまとめて設定し、配線に応じて回転方向の符号を合わせる。
void begin(uint32_t pwm_freq=20000, uint8_t pwm_resolution=8)
void setBoth(double duty_left, double duty_right)
void setLeft(double duty)
DiffMotors(MotorDriver &left, MotorDriver &right, bool left_reversed=false, bool right_reversed=true)
void setRight(double duty)
void setReversed(bool left_reversed, bool right_reversed)
単一MD10Cチャンネルのデバイス抽象。duty出力のみ。