BlockSolver クラス

#include <BlockSolver.h>

BlockSolver 連携図

公開メンバ関数
	BlockSolver ()=default
	BlockSolver (Controller &controller_, Walker &walker_, std::int32_t ipc_, const std::int16_t &targetBrightness_)
void	demo ()
	デモです。アリアに従って移動します。 [詳解]
void	run ()
	ブロック並べを攻略します。 [詳解]
void	moveRoute (std::vector< int > &route)
	ルートを移動します。 [詳解]
void	getBlockColor ()
	ブロックの色を取得し、blockColorに格納します。 [詳解]
void	passCircle (const Color &circle_color)
	ブロック置き場を乗り越えます。 [詳解]
void	moveOnLineToColor (std::int8_t pwm, std::int16_t target, const Color &circle_color, bool isRight)
	指定した色のブロック置き場までライントレースします。 [詳解]
void	moveDirection (const std::int8_t &nextPlace, bool remove_block=false)
	指定した方角へ移動します。 [詳解]
void	byeByeBlock ()
	バックして180ど回転し、来た方向へ戻ります。ブロックを放置するときに使います。 [詳解]
BlockSideBySide::Direction	getChangeDirection (std::int8_t angle)
	次に向かうべき方角を切り替えます。 [詳解]
Selector::BlockColor	convertSelectorColor (const Color &gameColor)
void	spinParkingArea ()

公開変数類
BlockSideBySide::Direction	nowDirection = BlockSideBySide::Direction::WEST
	今向いてる方角です。 [詳解]

詳解

BlockSolver.h の 19 行目に定義があります。

構築子と解体子

BlockSolver::BlockSolver ( )

default

BlockSolver::BlockSolver ( Controller &  controller_, Walker &  walker_, std::int32_t  ipc_, const std::int16_t &  targetBrightness_  )

inlineexplicit

BlockSolver.h の 22 行目に定義があります。

    : controller(controller_),
      walker(walker_),
      distinguisher(controller_),
      lifter(controller_),
      navigator(controller_, walker_),
      blockStrategy(ipc_),
      targetBrightness(targetBrightness_),
      ipc(ipc_)
  {
  }

関数詳解

void BlockSolver::byeByeBlock

(

)

バックして180ど回転し、来た方向へ戻ります。ブロックを放置するときに使います。

BlockSolver.cpp の 90 行目に定義があります。

{
  std::int8_t returnPlace = blockStrategy.blockArea.colorBlockPlaceArray[nowPlace]
                                ->black_line[getChangeDirection(2)]
                                ->getPlaceCord();
  moveDirection(returnPlace, true);
}

呼び出し関係図:

被呼び出し関係図:

Selector::BlockColor BlockSolver::convertSelectorColor

(

const Color &

gameColor

)

BlockSolver.cpp の 34 行目に定義があります。

{
  if(gameColor == Color::RED) {
    return Selector::BlockColor::Red;
  } else if(gameColor == Color::BLUE) {
    return Selector::BlockColor::Blue;
  } else if(gameColor == Color::GREEN) {
    return Selector::BlockColor::Green;
  } else if(gameColor == Color::YELLOW) {
    return Selector::BlockColor::Yellow;
  }
  return Selector::BlockColor::Undefined;
}

被呼び出し関係図:

void BlockSolver::demo

(

)

デモです。アリアに従って移動します。

BlockSolver.cpp の 8 行目に定義があります。

{
  // 最初の8番までのライントレース
  navigator.moveOnLine(500, targetBrightness, 55);
  moveOnLineToColor(45, targetBrightness - 10, Color::RED, false);

  // ブロックがある0番までの移動
  std::vector<int> route{ 8, 12, 13 };
  moveRoute(route);

  // ブロック読み取り(青だとする。)
  getBlockColor();
  if(blockColor == Color::BLUE) {
    // 青ブロックを10番まで移動。その後、9に戻る
    std::vector<int> route2 = { 13, 9, 10 };
    moveRoute(route2);
    byeByeBlock();
  }

  // 9番までの移動とパーキングの方を向く。
  std::vector<int> route3 = { 10, 9, 5, 6, 7, 11 };
  moveRoute(route3);
  passCircle(Color::GREEN);
  navigator.spin(90, false);
}

呼び出し関係図:

void BlockSolver::getBlockColor

(

)

ブロックの色を取得し、blockColorに格納します。

BlockSolver.cpp の 247 行目に定義があります。

{
  //ブロックの色をチェックして保持する
  controller.speakerPlayTone(controller.noteFs4, 100);
  lifter.liftUp(45, 10);
  blockColor = distinguisher.getColor();
  lifter.liftDown(0, 3);
  lifter.liftUp(1.5, 5);
}

呼び出し関係図:

被呼び出し関係図:

BlockSideBySide::Direction BlockSolver::getChangeDirection

(

std::int8_t

angle

)

次に向かうべき方角を切り替えます。

BlockSolver.cpp の 198 行目に定義があります。

{
  std::int8_t tmp = static_cast<std::int8_t>(nowDirection) + angle;
  if(tmp > 3) {
    tmp = tmp % 4;
  } else if(tmp < 0) {
    tmp = 4 + angle;
  }
  return static_cast<BlockSideBySide::Direction>(tmp);
}

被呼び出し関係図:

void BlockSolver::moveDirection	(	const std::int8_t &	nextPlace,
		bool	remove_block = false
	)

指定した方角へ移動します。

BlockSolver.cpp の 131 行目に定義があります。

{
  std::int8_t offset = 5;
  auto nextDirection = blockStrategy.blockArea.getDirection(nowPlace, nextPlace);
  auto nowColor = convertColor(blockStrategy.blockArea.colorBlockPlaceArray[nowPlace]->getColor());
  auto nextColor
      = convertColor(blockStrategy.blockArea.colorBlockPlaceArray[nextPlace]->getColor());

  std::int8_t diffDirection
      = static_cast<std::int8_t>(nextDirection) - static_cast<std::int8_t>(nowDirection);
  std::int16_t black_line_length = 250;
  if(nextDirection == BlockSideBySide::Direction::EAST
     || nextDirection == BlockSideBySide::Direction::WEST) {
    black_line_length = 300;
  }
  if(diffDirection == 0) {
    // 前方向に行く場合
    passCircle(nowColor);
  } else if(diffDirection == -1 || diffDirection == 3) {
    // 左方向に行く場合
    passCircle(nowColor);
    navigator.spin(110, false);
    // spinToBlack(false);
    nowDirection = getChangeDirection(-1);
  } else if(diffDirection == 1 || diffDirection == -3) {
    // 右方向に行く場合
    passCircle(nowColor);
    navigator.spin(90, true);

    // spinToBlack(true);
    nowDirection = getChangeDirection(1);
  } else if(remove_block == false) {
    // 後方向に行く場合
    black_line_length -= 100;
    navigator.spin(170, true);

    // spinToBlack(true);
    nowDirection = getChangeDirection(2);
  } else {
    // 後方向に行く場合
    black_line_length -= 200;
    navigator.back(100);
    // spinToBlack(true);
    navigator.spin(170, true);

    nowDirection = getChangeDirection(2);
  }
  controller.speakerPlayTone(controller.noteFs4, 150);
  //navigator.moveOnLine(black_line_length - 40, targetBrightness - offset, 30);
  moveOnLineToColor(30, targetBrightness - offset, nextColor, false);
  nowPlace = nextPlace;
}

呼び出し関係図:

被呼び出し関係図:

void BlockSolver::moveOnLineToColor	(	std::int8_t	pwm,
		std::int16_t	target,
		const Color &	circle_color,
		bool	isRight
	)

指定した色のブロック置き場までライントレースします。

BlockSolver.cpp の 209 行目に定義があります。

{
  std::int8_t buf = 1;
  controller.tslpTsk(50);

  if(isRight == true) {
    buf = -1;
  }
  walker.reset();
  // ライントレースで用いるPID値のセット
  lineTracer.speedControl.setPid(2.0, 0.8, 0.1, pwm);
  lineTracer.turnControl.setPid(1.1, 0.1, 0.2, target);
  Color tmp;
  std::int8_t count = 0;
  // navigator.move(15);
  while(1) {
    tmp = distinguisher.getColor();
    // controller.printDisplay(10, "%4d %4d %4d", pwm, turn, target);
    lineTracer.runLine(walker.get_count_L(), walker.get_count_R(), controller.getBrightness());
    if(circle_color == tmp) {
      count++;
    } else {
      if(count > 0) {
        count--;
      }
      walker.run(lineTracer.getForward(), lineTracer.getTurn() * buf);
    }
    if(count >= 2 || controller.buttonIsPressedBack()) {
      walker.run(0, 0);
      break;
    }
    controller.tslpTsk(4);
  }
  walker.run(0, 0);
  controller.tslpTsk(50);
}

呼び出し関係図:

被呼び出し関係図:

void BlockSolver::moveRoute

(

std::vector< int > &

route

)

ルートを移動します。

BlockSolver.cpp の 98 行目に定義があります。

{
  bool isFirst = true;
  for(auto next_n : route) {
    if(isFirst == true) {
      isFirst = false;
      continue;
    } else if(next_n == nowPlace) {
      continue;
    }
    controller.tslpTsk(50);
    moveDirection(next_n);
  }
  controller.speakerPlayTone(controller.noteFs4, 300);
  return;
}

呼び出し関係図:

被呼び出し関係図:

void BlockSolver::passCircle

(

const Color &

circle_color

)

ブロック置き場を乗り越えます。

BlockSolver.cpp の 257 行目に定義があります。

{
  controller.speakerPlayTone(controller.noteFs4, 100);
  navigator.move(90, 5);
  walker.run(5, 0);
  Color tmp;
  std::int8_t count = 0;
  while(1) {
    tmp = distinguisher.getColor();
    if(Color::BLACK == tmp || Color::WHITE == tmp) {
      count++;
    } else {
      if(count > 0) {
        count--;
      }
    }
    if(count >= 1 || controller.buttonIsPressedBack()) {
      walker.run(0, 0);
      break;
    }
    controller.tslpTsk(4);
  }
  navigator.move(10, 5);
}

呼び出し関係図:

被呼び出し関係図:

void BlockSolver::run

(

)

ブロック並べを攻略します。

BlockSolver.cpp の 48 行目に定義があります。

{
  // 最初の8番までのライントレース
  //navigator.moveOnLine(500, targetBrightness, 60);
  moveOnLineToColor(50, targetBrightness - 10, Color::RED, false);
  std::vector<int> route{ 8, 9, 10, 11 };
  moveRoute(route);
  //spinParkingArea();

  return;
  Selector selector;
  selector.setBlockPositionList({ 8, 9, 11, 15 });  // ipcd.getInitialPositionCodeList());

  Selector::BlockColor b_color = Selector::Undefined;
  while(!selector.isAlreadyAllBlockMoved()) {
    auto route = selector.exploreNextOperation(nowPlace, Selector::Undefined);  // b_color);

    // 目的地移動前にバックステップを行う必要がある場合
    if(selector.isBacksteppingBeforeNextOperation()) {
      byeByeBlock();
    }

    // 移動
    moveRoute(route);

    if(selector.isMovingWithNext()) {
      // ブロックまで移動する場合
      getBlockColor();
      b_color = convertSelectorColor(blockColor);
    } else {
      // ブロックを移動する場合
      b_color = Selector::Undefined;
    }

    // 移動後にバックステップを行う必要がある場合
    if(selector.isBackstepping()) {
      byeByeBlock();
    }
  }
  spinParkingArea();
}

呼び出し関係図:

void BlockSolver::spinParkingArea

(

)

BlockSolver.cpp の 115 行目に定義があります。

{
  std::int8_t diffDirection = static_cast<std::int8_t>(BlockSideBySide::Direction::WEST)
                              - static_cast<std::int8_t>(nowDirection);
  passCircle(Color::GREEN);
  if(diffDirection == -1 || diffDirection == 3) {
    // 左方向に行く場合
    navigator.spin(110, false);
    nowDirection = getChangeDirection(-1);
  } else {
    // 右方向に行く場合
    navigator.spin(90, true);
    nowDirection = getChangeDirection(1);
  }
}

呼び出し関係図:

被呼び出し関係図:

メンバ詳解

BlockSideBySide::Direction BlockSolver::nowDirection = BlockSideBySide::Direction::WEST

今向いてる方角です。

BlockSolver.h の 58 行目に定義があります。

---

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

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