Parking クラス

駐車クラス [詳解]

#include "Parking.h"

Parking 連携図

公開メンバ関数
	Parking (Controller &controller_)
void	runParpendicular (int16_t target_brightness, LineTracerWalker lineTracer, int16_t black, int16_t white)
void	runParallel (int16_t brightness, int16_t black, int16_t white, int16_t gray)
void	waitThreeTimes ()
void	ev3_remaining_amount ()

詳解

駐車クラス

Parking.h の 18 行目に定義があります。

構築子と解体子

Parking::Parking ( Controller &  controller_ )

inlineexplicit

コンストラクタ カラーセンサを初期化する。

Parking.h の 24 行目に定義があります。

: controller(controller_){};

関数詳解

void Parking::ev3_remaining_amount

(

)

void Parking::runParallel	(	int16_t	brightness,
		int16_t	black,
		int16_t	white,
		int16_t	gray
	)

直角駐車を実行する。 実行開始時にBasicWalkerクラスのインスタンスを生成し、 goStraightメンバ関数とspinメンバ関数に依存する。

Parking.cpp の 57 行目に定義があります。

{
  LineTracerWalker lineTracer;
  BasicWalker basicWalker{ controller };
  int count = 0;
  int16_t grayBrightness = (gray + white) / 2;
  // controller.tslpTsk(500);

  controller.printDisplay(6, ">>>>> Do ParallelParking... <<<<<");
  lineTracer.speedControl.setPid(1.5, 0.01, 0.12, 170.0);
  lineTracer.turnControl.setPid(2.0, 0.1, 0.1, brightness - 20);
  while(1) {
    int16_t luminance = controller.getBrightness();
    lineTracer.runLine(walker.get_count_L(), walker.get_count_R(), luminance);

    if(lineTracer.getForward() < 0) {
      walker.run(0, 0);
    } else {
      walker.run(lineTracer.getForward(), lineTracer.getTurn());
    }
    if(controller.buttonIsPressedBack()) {
      walker.run(0, 0);
      break;
    }

    if(black + 35 >= luminance) {  //ブラックを読み込んだら
      count = 0;
      controller.speakerPlayTone(controller.noteFs4, 10);
    } else if(white + 40 >= luminance && white - 70 <= luminance) {  //+30 -70
      count++;
      // controller.speakerPlayTone(controller.noteFs6, 100);
    }

    if(count > 80) {  // 250
      // waitThreeTimes();
      basicWalker.reset();
      basicWalker.setPidWithoutTarget(14.0, 1.0, 0.1);
      basicWalker.goStraight(60, 200);
      break;
    }

    lineTracer.speedControl.setPid(1.5, 0.01, 0.12, 170.0);
    // lineTracer.speedControl.setPid(17.0, 1.0, 0.1, 30.0);

    if(grayBrightness + 1 >= luminance && grayBrightness - 1 <= luminance) {
      // lineTracer.turnControl.setPid(4.0, 1.0, 0.8, grayBrightness);
      lineTracer.turnControl.setPid(2.0, 0.1, 0.1, grayBrightness - 25);
    } else {
      // lineTracer.turnControl.setPid(4.0, 1.0, 0.8, brightness);
      lineTracer.turnControl.setPid(2.0, 0.1, 0.1, brightness - 20);
    }
    controller.tslpTsk(4);
  }
  // sprintf(aa, "%f", controller.ev3_battery_voltage());

  // controller.printDisplay(5, aa);
  basicWalker.reset();
  basicWalker.setPidWithoutTarget(14.0, 1.0, 0.1);
  basicWalker.spin(basicWalker.SPIN_LEFT, 40);
  // basicWalker.setPidWithoutTarget(14.0, 1.0, 0.1);
  basicWalker.goStraight(60, 550);
  basicWalker.spin(basicWalker.SPIN_LEFT, 90);
  // basicWalker.goStraight(30, 10);
  // basicWalker.spin( basicWalker.SPIN_RIGHT, 90 );
}

呼び出し関係図:

void Parking::runParpendicular	(	int16_t	target_brightness,
		LineTracerWalker	lineTracer,
		int16_t	black,
		int16_t	white
	)

縦列駐車を実行する。 実行開始時にBasicWalkerクラスのインスタンスを生成し、 goStraightメンバ関数とspinメンバ関数に依存する。

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

{
  BasicWalker basicWalker{ controller };

  controller.printDisplay(0, "Do ParallelParking...");
  basicWalker.setPidWithoutTarget(5.0, 0.8, 0.2);
  basicWalker.goStraightToCheckBlackLine(30, 1000, target_brightness);

  basicWalker.spin(basicWalker.SPIN_LEFT, 70);
  // waitThreeTimes();
  basicWalker.spinToCheckBlackLine(basicWalker.SPIN_RIGHT, 70);
  basicWalker.reset();

  // waitThreeTimes();

  //ライントレース開始
  int count = 0;
  while(1) {
    int16_t now_brightness = controller.getBrightness();
    lineTracer.speedControl.setPid(5.0, 0.8, 0.2, 20.0);
    lineTracer.turnControl.setPid(2.2, 0.1, 0.35, target_brightness);  // 2.0,0.2,0.4 最高か

    lineTracer.runLine(walker.get_count_L(), walker.get_count_R(), now_brightness);
    if(lineTracer.getForward() < 0) {
      walker.run(0, 0);
    } else {
      walker.run(lineTracer.getForward(), lineTracer.getTurn());
    }
    if(controller.buttonIsPressedBack()) {
      walker.run(0, 0);
      break;
    }

    count++;

    if(count > 450) {
      break;
    }
    controller.tslpTsk(4);
  }  // whileのおわり

  basicWalker.setPidWithoutTarget(5.0, 0.8, 0.2);
  basicWalker.reset();
  basicWalker.goStraight(30, 450);
  waitThreeTimes();
}

呼び出し関係図:

void Parking::waitThreeTimes

(

)

3秒間待機する。 駐車完了後に使う。 その際、1秒ごとに音を鳴らす。 EV3APIに依存する。

Parking.cpp の 123 行目に定義があります。

{
  walker.run(0, 0);
  controller.speakerPlayTone(controller.noteFs4, 100);
  controller.tslpTsk(1000);
  controller.speakerPlayTone(controller.noteFs4, 100);
  controller.tslpTsk(1000);
  controller.speakerPlayTone(controller.noteFs4, 100);
  controller.tslpTsk(1000);
  controller.speakerPlayTone(controller.noteFs4, 800);
}

呼び出し関係図:

被呼び出し関係図:

---

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

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