DLink/DLink.cpp at master · botamochi/DLink · 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
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
//======================================================================
// デジモンギアとの通信
// DLink.cpp
// 2015/1/23 作成
//======================================================================
#include "Arduino.h"
#include "DLink.h"

//--------------------------------------------------
// コンストラクタ
// inputPin  : データ読み取り用のピン
// outputPin : データ出力用のピン
//--------------------------------------------------
DLink::DLink(int inputPin, int outputPin)
  : pIn(inputPin), pOut(outputPin)
{
  pinMode(pIn, INPUT);
  pinMode(pOut, INPUT); // 送信時にOUTPUTにする
  digitalWrite(pOut, HIGH);
  isBegin = false;
}

//--------------------------------------------------
// データ読み取り
// timeout : Startパルスを受信までのタイムアウト時間(ms)
// 戻り値  : 受信したデータフレーム, 失敗した場合は0
//--------------------------------------------------
dframe DLink::receive(unsigned int timeout)
{
  dframe frame = 0;
  unsigned long tm, thr;

  //------------------------------
  // Start
  //------------------------------
  if (timeout == 0) {
    while (digitalRead(pIn) == HIGH);
  } else {
    while (digitalRead(pIn) == HIGH) {
      delay(1);
      timeout--;
      if (timeout == 0) return 0;
    }
  }
  //------------------------------
  // Head
  //------------------------------
  if ((thr = pulseIn(pIn, HIGH, 100000)) == 0) return 0;
  //------------------------------
  // Data
  //------------------------------
  for (int i = 0; i < 16; i++) {
    if ((tm = pulseIn(pIn, HIGH, 8000)) == 0) return 0;
    if (tm > thr) frame |= (1<<i);
  }
  while (digitalRead(pIn) == LOW);
  return frame;
}

//--------------------------------------------------
// 送信開始
// Startパルスを送信する
// 先に送信しておくことで60msの間に処理が行える
//--------------------------------------------------
void DLink::begin()
{
  if (isBegin == true) return;
  pinMode(pOut, OUTPUT);
  digitalWrite(pOut, LOW);
  isBegin = true;
  beginTime = millis();
}

//--------------------------------------------------
// 1フレーム送信
// frame : 送信するデータフレーム
//--------------------------------------------------
void DLink::send(dframe frame)
{
  //------------------------------
  // Start
  //------------------------------
  begin();
  while (millis() - beginTime < 60);
  //------------------------------
  // Head
  //------------------------------
  digitalWrite(pOut, HIGH);
  delayMicroseconds(2000);
  digitalWrite(pOut, LOW);
  delayMicroseconds(1000);
  //------------------------------
  // Data
  //------------------------------
  for (int i = 0; i < 16; i++) {
    if (frame & (1<<i)) {
      digitalWrite(pOut, HIGH);
      delayMicroseconds(2500);
      digitalWrite(pOut, LOW);
      delayMicroseconds(1500);
    } else {
      digitalWrite(pOut, HIGH);
      delayMicroseconds(1000);
      digitalWrite(pOut, LOW);
      delayMicroseconds(3000);
    }
  }
  digitalWrite(pOut, HIGH);
  pinMode(pOut, INPUT);
  isBegin = false;
  delayMicroseconds(1000);
}


//--------------------------------------------------
// 初代ギアのバトル
// mode : true->自分からバトル開始, false->バトル待ち
// 戻り値 : true->通信成功, false->通信失敗
//--------------------------------------------------
DataSetOrigin DLinkOrigin::battle(DataSetOrigin dataset, bool mode, unsigned int timeout)
{
  int i;
  DataSetOrigin recvdata;

  if (mode == true) {
    dataset.field.padding1 = ~((unsigned char)dataset.field.effort << 4 | dataset.field.species);
    dataset.field.padding2 = ~((unsigned char)dataset.field.version << 4 | dataset.field.victory);
    for (i = 0; i < 2; i++) {
      send(dataset.frame[i]);
      recvdata.frame[i] = receive(timeout);
      if (recvdata.frame[i] == 0) {
        recvdata.frame[0] = 0;
        recvdata.frame[1] = 0;
        return recvdata;
      }
    }
  } else {
    dataset.field.padding1 = ~((unsigned char)dataset.field.effort << 4 | dataset.field.species);
    for (i = 0; i < 2; i++) {
      recvdata.frame[i] = receive(timeout);
      if (recvdata.frame[i] == 0) {
        recvdata.frame[0] = 0;
        recvdata.frame[1] = 0;
        return recvdata;
      }
      begin();
      if (i == 1) {
        dataset.field.victory = recvdata.field.victory == WIN ? LOSE : WIN;
        dataset.field.padding2 = ~((unsigned char)dataset.field.version << 4 | dataset.field.victory);
      }
      send(dataset.frame[i]);
    }
  }
  return recvdata;
}