gyo
SBDBT.cpp
- Committer:
- gotto0
- Date:
- 2017-05-06
- Revision:
- 3:16a15d26ebe8
- Parent:
- 2:1472e7c5317d
- Child:
- 5:a4a994824c96
File content as of revision 3:16a15d26ebe8:
#include "SBDBT.h" namespace raven { SBDBT::SBDBT(PinName p1, PinName p2) { i = 0; readable = 0; length = 8; value = 128; position = 0; tmp = new char [length]; data = new char [length]; sr = new Serial(p1,p2); sr -> baud(2400); sr -> attach(this,&SBDBT::getf,Serial::RxIrq); } SBDBT::SBDBT(PinName p1, PinName p2, int baud) { i = 0; readable = 0; length = 8; value = 128; position = 0; tmp = new char [length]; data = new char [length]; sr = new Serial(p1,p2); sr -> baud(baud); sr -> attach(this,&SBDBT::getf,Serial::RxIrq); } void SBDBT::getf() { tmp[i] = sr -> getc(); if(tmp[i] == value) //受信したデータが訂正用定数であり { if(i != position) //訂正用定数を受信すべき位置でないとき { tmp[position] = value; //正しい位置に訂正用定数を代入 i = position + 1; //受信先も正しい位置へもどす } else //訂正用定数を受信すべき位置であるとき i++; //次の位置で受信する } else //受信したデータが訂正用定数でなく { if(i == position){} //訂正用定数を受信すべき位置であるとき //再度同じ位置で受信する else //訂正用定数を受信すべき場所でないとき i++; //次の位置で受信する } if(i>=length) //位置がデータの長さを超えたら { data[0] = tmp[0]; data[1] = tmp[1]; data[2] = tmp[2]; data[3] = tmp[3]; data[4] = tmp[4]; data[5] = tmp[5]; data[6] = tmp[6]; data[7] = tmp[7]; readable = 1; //全データ受信完了 i=0; //位置を初期化 } } SBDBT::~SBDBT() { delete sr; } }//namespace