PlaRail2013/Station.cpp at master · sobataro/PlaRail2013 · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
#include "Station.h"

Station::Station(Signal *masterSignal, Signal *slaveSignal, int crossingServoPin) : Signal::Signal() {
  this->masterSignal = masterSignal;
  this->slaveSignal = slaveSignal;
  this->crossingServoPin = crossingServoPin;
  crossingServo.attach(crossingServoPin);
  changeCrossing(SERVO_ANGLE_MASTER);
}

void Station::setNextSignal(Signal *nextSignal) {
  masterSignal->setNextSignal(nextSignal);
  slaveSignal->setNextSignal(nextSignal);
}

boolean Station::check() {
  int check = 0;

  if (!masterSignal->canEnter(NULL)) {
    // override slave's signal to red
    slaveSignal->restrict();
  } else {
    slaveSignal->release();
  }
  check += masterSignal->check();
  check += slaveSignal->check();

  return check;
}

boolean Station::printTrainIfExists() {
  return masterSignal->printTrainIfExists() + slaveSignal->printTrainIfExists();
}

void Station::changeCrossing(int servoAngle) {
  currentServoAngle = servoAngle;
  crossingServo.write(servoAngle);
}

boolean Station::isTrainOnCrossing() {
  return masterSignal->getState() == Signal::RUNNING || slaveSignal->getState() == Signal::RUNNING;
}

boolean Station::canEnter(Train *train) {
  if (isTrainOnCrossing()) {
    return false;
  }
  if (train == NULL) {
    // 現在開通している方
    if (currentServoAngle == SERVO_ANGLE_MASTER) {
      return masterSignal->canEnter(train);
    } else {
      return slaveSignal->canEnter(train);
    }
  } else if (train->getType() == EXPRESS) {
    // goto 主本線
    changeCrossing(SERVO_ANGLE_MASTER);
    return masterSignal->canEnter(train);
  } else if (train->getType() == RAPID) {
    // goto 副本線
    changeCrossing(SERVO_ANGLE_SLAVE);
    return slaveSignal->canEnter(train);
  }
}

boolean Station::enter(Train *train) {
  Serial.println("Station::enter()");
  switch (train->getType()) {
  case EXPRESS:
    // goto 主本線
    return masterSignal->enter(train);
    break;
  case RAPID:
    // goto 副本線
    return slaveSignal->enter(train);
    break;
  }
}