11/* *
2- * @file Controller .cpp
2+ * @file MotorController .cpp
33 * @brief モータ制御に用いる関数をまとめたラッパークラス
44 * @author nishijima515
55 */
66#include " MotorController.h"
77
8- Controller::Controller ()
8+ MotorController::MotorController ()
99 : rightWheel(Port::PORT_A),
1010 leftWheel(Port::PORT_B, Motor::EDirection::COUNTERCLOCKWISE),
1111 armMotor(Port::PORT_C, Motor::EDirection::COUNTERCLOCKWISE)
1212{
1313}
1414
1515// power値の初期化
16- int Controller ::powerOfRightWheel = 0 ;
17- int Controller ::powerOfLeftWheel = 0 ;
18- int Controller ::powerOfArm = 0 ;
16+ int MotorController ::powerOfRightWheel = 0 ;
17+ int MotorController ::powerOfLeftWheel = 0 ;
18+ int MotorController ::powerOfArm = 0 ;
1919
2020// モータに設定するpower値の制限
21- int Controller ::limitPowerValue (int inputPower)
21+ int MotorController ::limitPowerValue (int inputPower)
2222{
2323 if (inputPower > MOTOR_POWER_MAX) {
2424 return MOTOR_POWER_MAX;
@@ -29,133 +29,133 @@ int Controller::limitPowerValue(int inputPower)
2929}
3030
3131// 右モータにpower値をセット
32- void Controller ::setRightMotorPower (int power)
32+ void MotorController ::setRightMotorPower (int power)
3333{
3434 powerOfRightWheel = limitPowerValue (power);
3535 rightWheel.setPower (powerOfRightWheel);
3636}
3737
3838// 左モータにpower値をセット
39- void Controller ::setLeftMotorPower (int power)
39+ void MotorController ::setLeftMotorPower (int power)
4040{
4141 powerOfLeftWheel = limitPowerValue (power);
4242 leftWheel.setPower (powerOfLeftWheel);
4343}
4444
4545// 右モータのpower値をリセット
46- void Controller ::resetRightMotorPower ()
46+ void MotorController ::resetRightMotorPower ()
4747{
4848 rightWheel.setPower (0 );
4949}
5050
5151// 左モータのpower値をリセット
52- void Controller ::resetLeftMotorPower ()
52+ void MotorController ::resetLeftMotorPower ()
5353{
5454 leftWheel.setPower (0 );
5555}
5656
5757// 右左両モータの状態をリセット
58- void Controller ::resetWheelsMotorPower ()
58+ void MotorController ::resetWheelsMotorPower ()
5959{
6060 rightWheel.setPower (0 );
6161 leftWheel.setPower (0 );
6262}
6363
6464// 右タイヤのモータに回転速度をセット
65- void Controller ::setRightMotorSpeed (int speed)
65+ void MotorController ::setRightMotorSpeed (int speed)
6666{
6767 rightWheel.setSpeed (speed);
6868}
6969
7070// 左タイヤのモータに回転速度をセット
71- void Controller ::setLeftMotorSpeed (int speed)
71+ void MotorController ::setLeftMotorSpeed (int speed)
7272{
7373 leftWheel.setSpeed (speed);
7474}
7575
7676// 両タイヤのモータを停止する
77- void Controller ::stopWheelsMotor ()
77+ void MotorController ::stopWheelsMotor ()
7878{
7979 rightWheel.stop ();
8080 leftWheel.stop ();
8181}
8282
8383// ブレーキをかけてタイヤのモータを停止する
84- void Controller ::brakeWheelsMotor ()
84+ void MotorController ::brakeWheelsMotor ()
8585{
8686 rightWheel.brake ();
8787 leftWheel.brake ();
8888}
8989
9090// アームのモータにpower値をセット
91- void Controller ::setArmMotorPower (int power)
91+ void MotorController ::setArmMotorPower (int power)
9292{
9393 powerOfArm = limitPowerValue (power);
9494 armMotor.setPower (powerOfArm);
9595}
9696
9797// アームのモータのpower値をリセット
98- void Controller ::resetArmMotorPower ()
98+ void MotorController ::resetArmMotorPower ()
9999{
100100 armMotor.setPower (0 );
101101}
102102
103103// アームのモータを停止する
104- void Controller ::stopArmMotor ()
104+ void MotorController ::stopArmMotor ()
105105{
106106 armMotor.stop ();
107107}
108108
109109// アームモータを止めて角度を維持する
110- void Controller ::holdArmMotor ()
110+ void MotorController ::holdArmMotor ()
111111{
112112 armMotor.hold ();
113113}
114114
115115// 右タイヤのpower値を取得する
116- int Controller ::getRightMotorPower ()
116+ int MotorController ::getRightMotorPower ()
117117{
118118 return rightWheel.getPower ();
119119}
120120
121121// 左タイヤのpower値を取得する
122- int Controller ::getLeftMotorPower ()
122+ int MotorController ::getLeftMotorPower ()
123123{
124124 return leftWheel.getPower ();
125125}
126126
127127// アームモータのpower値を取得する
128- int Controller ::getArmMotorPower ()
128+ int MotorController ::getArmMotorPower ()
129129{
130130 return armMotor.getPower ();
131131}
132132
133133// 右モータの角位置を取得する
134- int32_t Controller ::getRightMotorCount ()
134+ int32_t MotorController ::getRightMotorCount ()
135135{
136136 return rightWheel.getCount ();
137137}
138138
139139// 左モータの角位置を取得する
140- int32_t Controller ::getLeftMotorCount ()
140+ int32_t MotorController ::getLeftMotorCount ()
141141{
142142 return leftWheel.getCount ();
143143}
144144
145145// アームモータの角位置を取得する
146- int32_t Controller ::getArmMotorCount ()
146+ int32_t MotorController ::getArmMotorCount ()
147147{
148148 return armMotor.getCount ();
149149}
150150
151151// 右タイヤモータの回転速度を取得する
152- int32_t Controller ::getRightMotorSpeed ()
152+ int32_t MotorController ::getRightMotorSpeed ()
153153{
154154 return rightWheel.getSpeed ();
155155}
156156
157157// 左タイヤモータの回転速度を取得する
158- int32_t Controller ::getLeftMotorSpeed ()
158+ int32_t MotorController ::getLeftMotorSpeed ()
159159{
160160 return leftWheel.getSpeed ();
161161}
0 commit comments