アブソリュートエンコーダを用いた、DCモータの位置制御を行うためのクラス More...

#include <Cubic.controller.h>

Inheritance diagram for Cubic_controller::Position_PID:

Public Member Functions
	Position_PID (uint8_t motorNo, uint8_t encoderNo, enum class encoderType encoderType, uint16_t CPR, double Kp, double Ki, double Kd, double target, bool direction, double capableDutyCycle=1.0, bool logging=false)
	Construct a new Position_PID object.

void	setTarget (double target) override
	制御量の目標値を設定します。

double	encoderToAngle (int32_t encoder) override
	エンコーダの値から角度を計算します。設定したCPR(Count Per Revolution)に依存します。

double	compute () override
	duty比を計算します。各ループで一回呼び出してください。このduty比は、DUTY_SPI_MAXに対する比です。計算された値は、この関数内部で、DC_motor::put()されます。

Public Member Functions inherited from Cubic_controller::Controller
	Controller (uint8_t motorNo, uint8_t encoderNo, enum class encoderType encoderType, uint16_t CPR, double Kp, double Ki, double Kd, double target, bool direction, double capableDutyCycle, double current, bool logging=false)
	Construct a new Controller object.

void	setGains (double Kp, double Ki, double Kd)
	PIDゲインを設定します。負の値は-1倍されます。

void	setKp (double Kp)
	Pゲインを設定します。負の値は-1倍されます。

void	setKi (double Ki)
	Iゲインを設定します。負の値は-1倍されます。

void	setKd (double Kd)
	Dゲインを設定します。負の値は-1倍されます。

int32_t	readEncoder () const
	エンコーダを読みだします。

double	getTarget () const
	目標値を返します。

double	getDutyCycle () const
	直前に計算したデューティ比を返します。

double	getDt () const
	直前のループにおける経過時間dtを返します

double	getCurrent () const
	直前に読んだ制御量を返します。

virtual void	reset ()
	制御器のリセット

virtual void	reset (double target)
	制御器のリセット

virtual void	reset (double Kp, double Ki, double Kd)
	制御器のリセット

virtual void	reset (double Kp, double Ki, double Kd, double target)
	制御器のリセット

Additional Inherited Members
Protected Member Functions inherited from Cubic_controller::Controller
double	compute_PID (double current)
	pid.compute_PID()を呼ぶだけの関数です。

Protected Attributes inherited from Cubic_controller::Controller
const uint8_t	motorNo
	モータ番号

enum encoderType	encoderType
	エンコーダの種類

const uint8_t	encoderNo
	エンコーダ番号

const uint16_t	CPR
	CPR(Counts Per Revolution)

const bool	direction
	モータをプラスの方向に回したとき、エンコーダが増加するかどうか

const bool	logging
	ログを出力するかどうか

Detailed Description

アブソリュートエンコーダを用いた、DCモータの位置制御を行うためのクラス

Constructor & Destructor Documentation

◆ Position_PID()

Cubic_controller::Position_PID::Position_PID	(	uint8_t	motorNo,
		uint8_t	encoderNo,
		enum class encoderType encoderType	,
		uint16_t	CPR,
		double	Kp,
		double	Ki,
		double	Kd,
		double	target,
		bool	direction,
		double	capableDutyCycle = 1.0,
		bool	logging = false )

Construct a new Position_PID object.

Parameters

motorNo	モータ番号
encoderNo	エンコーダ番号
encoderType	エンコーダの種類
CPR	エンコーダのCPR（PPRでないことに注意。CPR=PPR*4）
Kp
Ki
Kd
target	目標角度[rad] (-PI<= target < PI)
direction	モーターに正のdutyを与えたときに、エンコーダが正方向に回転するかどうか。trueなら正方向、falseなら負方向。
capableDutyCycle	最大許容デューティ比。0.0~1.0。省略可能で、デフォルトは1.0。
logging	ログをSerial.printで出力するかどうか。省略可能で、デフォルトはfalse。

Member Function Documentation

◆ compute()

double Cubic_controller::Position_PID::compute ( )

overridevirtual

duty比を計算します。各ループで一回呼び出してください。このduty比は、DUTY_SPI_MAXに対する比です。計算された値は、この関数内部で、DC_motor::put()されます。

Returns: double dutyCycle

Implements Cubic_controller::Controller.

◆ encoderToAngle()

double Cubic_controller::Position_PID::encoderToAngle ( int32_t encoder )

inlineoverridevirtual

エンコーダの値から角度を計算します。設定したCPR(Count Per Revolution)に依存します。

Parameters

encoder

Returns: double angle[rad](-PI<= angle < PI)

Implements Cubic_controller::Controller.

◆ setTarget()

void Cubic_controller::Position_PID::setTarget ( double target )

overridevirtual

制御量の目標値を設定します。

Parameters

target

Reimplemented from Cubic_controller::Controller.

The documentation for this class was generated from the following files:

Public Member Functions

Additional Inherited Members

Detailed Description

Constructor & Destructor Documentation

◆ Position_PID()

Member Function Documentation

◆ compute()

◆ encoderToAngle()

◆ setTarget()