LeftNormalCourse クラス

#include <LeftNormalCourse.h>

LeftNormalCourse の継承関係図

LeftNormalCourse 連携図

公開メンバ関数
	LeftNormalCourse ()
bool	runNormalCourse (int32_t countL, int32_t countR, int16_t light_value, int16_t target_brightness)
bool	statusCheck (int32_t countL, int32_t countR)
int	getStatus ()
基底クラス NormalCourse に属する継承公開メンバ関数
	NormalCourse ()
void	stop ()
void	runOrStop (Walker &walker)

その他の継承メンバ
基底クラス NormalCourse に属する継承公開変数類
LineTracerWalker	lineTracerWalker
基底クラス NormalCourse に属する継承限定公開変数類
MotorAngle	motor_angle
int8_t	forward
int8_t	turn

詳解

LコースのNormalCourseの処理を行うクラス

LeftNormalCourse.h の 32 行目に定義があります。

構築子と解体子

LeftNormalCourse::LeftNormalCourse

(

)

コンストラクタ。 左エッジである設定をしている

LeftNormalCourse.cpp の 9 行目に定義があります。

                                   : isChangedEdge(false), time_count(0)
{
  lineTracerWalker.isLeftsideLine(true);
  status = old_status = LeftStatus::STRAIGHT;
}

呼び出し関係図:

関数詳解

int LeftNormalCourse::getStatus

(

)

現在の走行場所の状態を取得する

戻り値

現在の走行場所の状態(int型)

LeftNormalCourse.cpp の 135 行目に定義があります。

{
  return (int)status;
}

bool LeftNormalCourse::runNormalCourse	(	int32_t	countL,
		int32_t	countR,
		int16_t	light_value,
		int16_t	target_brightness
	)

走行場所でのPID値を設定する

戻り値

Goalしたかどうか

LeftNormalCourse.cpp の 15 行目に定義があります。

{
  switch(status) {
    case LeftStatus::START:
      lineTracerWalker.speedControl.setPid(1.2, 0.01, 0.12, 170.0);
      lineTracerWalker.turnControl.setPid(2.0, 0.1, 0.1, target_brightness);
      lineTracerWalker.runLine(countL, countR, light_value);
      break;

    case LeftStatus::STRAIGHT:
      lineTracerWalker.speedControl.setPid(8.0, 1.0, 0.1, 200.0);
      lineTracerWalker.turnControl.setPid(2.0, 1.0, 0.1, target_brightness);
      lineTracerWalker.runLine(countL, countR, light_value);
      break;

    case LeftStatus::EDGE_CHANGE:
      lineTracerWalker.speedControl.setPid(3.5, 0.01, 0.12, 180.0);
      lineTracerWalker.turnControl.setPid(2.0, 1.0, 0.1, target_brightness);
      lineTracerWalker.runLine(countL, countR, light_value);
      break;

    case LeftStatus::EDGE_RESET:
      lineTracerWalker.speedControl.setPid(2.0, 0.5, 0.7, 180.0);
      lineTracerWalker.turnControl.setPid(2.0, 0.01, 0.2, target_brightness);
      lineTracerWalker.runLine(countL, countR, light_value);
      break;

    case LeftStatus::CURVE_LEFT:
      lineTracerWalker.speedControl.setPid(2.0, 0.5, 0.6, 180.0);
      lineTracerWalker.turnControl.setPid(4.2, 0.08, 0.4, target_brightness);
      lineTracerWalker.runLine(countL, countR, light_value);
      break;

    case LeftStatus::CURVE_LEFT_SHORT:
      lineTracerWalker.speedControl.setPid(4.0, 0.8, 0.1, 150.0);
      lineTracerWalker.turnControl.setPid(4.5, 0, 0.4, target_brightness);
      lineTracerWalker.runLine(countL, countR, light_value);
      break;

    case LeftStatus::STRAIGHT_SLOW:
      lineTracerWalker.speedControl.setPid(8.0, 1.0, 0.1, 200.0);
      lineTracerWalker.turnControl.setPid(1.0, 1.0, 0.2, target_brightness);
      lineTracerWalker.runLine(countL, countR, light_value);
      break;

      /*
      case LeftStatus::STRAIGHT_SLOW:
        lineTracerWalker.setForward(15);
        lineTracerWalker.setTurn(-2);
        lineTracerWalker.isLeftsideLine(false);
        time_count++;
        if(light_value > target_brightness && time_count > 125) isChangedEdge = true;
        break;

      case LeftStatus::NEUTRAL:
        lineTracerWalker.speedControl.setPid(4.0, 0.2, 0.08, 100.0);
        lineTracerWalker.turnControl.setPid(2.0, 1.0, 0.048, target_brightness - 5.0);
        lineTracerWalker.runLine(countL, countR, light_value);
        break;

      case LeftStatus::CURVE_RIGHT:
        lineTracerWalker.speedControl.setPid(4.0, 0.8, 0.08, 10.0);
        lineTracerWalker.turnControl.setPid(4.0, 2.0, 0.1, target_brightness + 5.0);
        // lineTracerWalker.turnControl.setPid ( 4.0, 2.0, 0.096, 40.0 );
        lineTracerWalker.runLine(countL, countR, light_value);
        break;

      case LeftStatus::STRAIGHT_THIRD:
        lineTracerWalker.speedControl.setPid(8.0, 1.0, 0.1, 160.0);
        lineTracerWalker.turnControl.setPid(2.0, 1.0, 0.1, target_brightness - 10);
        lineTracerWalker.runLine(countL, countR, light_value);
        break;

      case LeftStatus::START:
        lineTracerWalker.speedControl.setPid(1.5, 0.01, 0.12, 170.0);
        lineTracerWalker.turnControl.setPid(2.0, 0.1, 0.1, target_brightness);
        lineTracerWalker.runLine(countL, countR, light_value);
        break;*/

    case LeftStatus::STOP:
      stop();
      break;
    default:
      stop();
  }
  if(status == LeftStatus::STOP) return false;
  return true;
}

呼び出し関係図:

被呼び出し関係図:

bool LeftNormalCourse::statusCheck	(	int32_t	countL,
		int32_t	countR
	)

現在の走行場所の状態を設定する

引数

[in]	countL	左タイヤの回転角
[in]	countR	右タイヤの回転角

戻り値

走行場所の状態が変わったかどうか

LeftNormalCourse.cpp の 105 行目に定義があります。

{
  std::int32_t distance_total = motor_angle.absoluteAngleMean(countL, countR);
  old_status = status;
  if(distance_total < 300)
    status = LeftStatus::START;
  else if(distance_total < 2850)
    status = LeftStatus::STRAIGHT;
  else if(distance_total < 6600)
    status = LeftStatus::STRAIGHT;
  else if(distance_total < 7400)
    status = LeftStatus::EDGE_RESET;
  else if(distance_total < 8150)
    status = LeftStatus::STRAIGHT_SLOW;
  else if(distance_total < 9000)
    status = LeftStatus::CURVE_LEFT;
  else if(distance_total < 11700)
    status = LeftStatus::STRAIGHT;
  else if(distance_total < 12900)
    status = LeftStatus::CURVE_LEFT_SHORT;
  else
    status = LeftStatus::STOP;

  if(isChangedEdge) {
    status = LeftStatus::STOP;
  }
  if(old_status != status) return true;
  return false;
}

呼び出し関係図:

被呼び出し関係図:

---

このクラス詳解は次のファイルから抽出されました:

• str/apps/include/LeftNormalCourse.h
• str/apps/src/LeftNormalCourse.cpp