初始化提交
This commit is contained in:
36
arduino-cli/libraries/QDPASR/QDPASR.cpp
Normal file
36
arduino-cli/libraries/QDPASR/QDPASR.cpp
Normal file
@@ -0,0 +1,36 @@
|
||||
#include "QDPASR.h"
|
||||
|
||||
|
||||
void QDPASR::begin(Stream& stream){
|
||||
_serial = &stream;
|
||||
}
|
||||
|
||||
void QDPASR::ReceiveData(){
|
||||
if (_serial->available() > 0) {
|
||||
ReceiveByte = _serial->read();
|
||||
if (ReceiveByte == ',') {
|
||||
ReceiveString = _serial->readStringUntil('.');
|
||||
if(ReceiveString.length()>=14)
|
||||
ReceiveString = ReceiveString.substring(0,14);
|
||||
// Serial.println(ReceiveString);
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
void QDPASR::SendData(String Data){
|
||||
_serial->write(',');
|
||||
_serial->print(Data);
|
||||
_serial->write('.');
|
||||
}
|
||||
|
||||
bool QDPASR::CompareData(String Data){
|
||||
if(Data.length()>=14)
|
||||
Data = Data.substring(0,14);
|
||||
if( ReceiveString == Data){
|
||||
ReceiveString = "";
|
||||
return true;
|
||||
}
|
||||
else{
|
||||
return false;
|
||||
}
|
||||
}
|
||||
17
arduino-cli/libraries/QDPASR/QDPASR.h
Normal file
17
arduino-cli/libraries/QDPASR/QDPASR.h
Normal file
@@ -0,0 +1,17 @@
|
||||
#include "Arduino.h"
|
||||
#ifndef QDPASR_H
|
||||
#define QDPASR_H
|
||||
|
||||
class QDPASR {
|
||||
Stream* _serial;
|
||||
public:
|
||||
void begin(Stream& stream);
|
||||
void ReceiveData();
|
||||
void SendData(String Data);
|
||||
bool CompareData(String Data);
|
||||
private:
|
||||
byte ReceiveByte;
|
||||
String ReceiveString;
|
||||
};
|
||||
|
||||
#endif
|
||||
Reference in New Issue
Block a user