mirror of
http://172.16.0.230/r/SIF/TowerOptoSifAndSpectral.git
synced 2025-10-19 03:49:42 +08:00
添加了 温湿度传感器控制代码 已能读取 等待拷机测试
This commit is contained in:
140
source/Misc_Detector/GY39Controller.cpp
Normal file
140
source/Misc_Detector/GY39Controller.cpp
Normal file
@ -0,0 +1,140 @@
|
||||
#include "GY39Controller.h"
|
||||
#include "ZZ_Types.h"
|
||||
using namespace ZZ_MISCDEF;
|
||||
|
||||
GY39Controller::GY39Controller(QObject* parent /*= nullptr*/)
|
||||
{
|
||||
m_pSerialPort = new QSerialPort;
|
||||
m_iBaudRate = 9600;
|
||||
}
|
||||
|
||||
GY39Controller::~GY39Controller()
|
||||
{
|
||||
if (m_pSerialPort != NULL)
|
||||
{
|
||||
delete m_pSerialPort;
|
||||
}
|
||||
}
|
||||
|
||||
int GY39Controller::SendCommand(QByteArray qbCommand)
|
||||
{
|
||||
qint64 qi64Write = m_pSerialPort->write(qbCommand);
|
||||
if (qi64Write != qbCommand.size())
|
||||
{
|
||||
qDebug() << "Err:write Failed.Exit Code:1" << qi64Write;
|
||||
return 1;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
int GY39Controller::RecvHumitureData(QByteArray &qbData)
|
||||
{
|
||||
qbData.clear();
|
||||
qbData = m_pSerialPort->readAll();
|
||||
|
||||
int iCounter = 0;
|
||||
while (qbData.size() < 15)
|
||||
{
|
||||
m_pSerialPort->waitForReadyRead(50);
|
||||
QByteArray qbTemp = m_pSerialPort->readAll();
|
||||
qbData.append(qbTemp);
|
||||
|
||||
if (iCounter > 10)
|
||||
{
|
||||
qDebug() << "Err:RecvHumitureData Failed,Not Enough Data.Exit Code:1" << qbData.size();
|
||||
return 1;
|
||||
}
|
||||
iCounter++;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
int GY39Controller::ParseHumitureData(QByteArray &qbData)
|
||||
{
|
||||
ZZ_U8 cTempH8, cTempL8, cHumH8, cHumL8;
|
||||
|
||||
cTempH8 = qbData[4];
|
||||
cTempL8 = qbData[5];
|
||||
|
||||
cHumH8 = qbData[10];
|
||||
cHumL8 = qbData[11];
|
||||
|
||||
float fTemp = (cTempH8 << 8) | cTempL8;
|
||||
fTemp = fTemp / 100;
|
||||
float fHum = (cHumH8 << 8) | cHumL8;
|
||||
fHum = fHum / 100;
|
||||
|
||||
m_fTemperature = fTemp;
|
||||
m_fHumidity = fHum;
|
||||
return 0;
|
||||
}
|
||||
|
||||
int GY39Controller::Initialize(std::string ucPortName, bool bAuto15/*=false*/, bool bAuto45/*=false*/)
|
||||
{
|
||||
QString qstrPortName = QString::fromStdString(ucPortName);
|
||||
|
||||
m_pSerialPort->setPortName(qstrPortName);
|
||||
m_pSerialPort->setReadBufferSize(512);
|
||||
bool bRes = m_pSerialPort->setBaudRate(m_iBaudRate);
|
||||
if (!bRes)
|
||||
{
|
||||
qDebug() << "Err:setBaudRate Failed.Exit Code:1";
|
||||
//std::cout << "Err.setBaudRate Failed" << std::endl;
|
||||
return 1;
|
||||
}
|
||||
|
||||
bRes = m_pSerialPort->open(QIODevice::ReadWrite);
|
||||
if (!bRes)
|
||||
{
|
||||
qDebug() << "Err:open Failed.Exit Code:2";
|
||||
//std::cout << "Err.open Failed" << std::endl;
|
||||
return 2;
|
||||
}
|
||||
|
||||
QByteArray qbSend;
|
||||
|
||||
if (bAuto15==false && bAuto45==false)
|
||||
{
|
||||
qbSend.resize(3);
|
||||
qbSend[0] = (ZZ_U8)0xA5;
|
||||
qbSend[1] = (ZZ_U8)0x00;
|
||||
qbSend[2] = (ZZ_U8)0xA5;
|
||||
}
|
||||
|
||||
if (bAuto15 == true && bAuto45 == true)
|
||||
{
|
||||
qbSend.resize(3);
|
||||
qbSend[0] = (ZZ_U8)0xA5;
|
||||
qbSend[1] = (ZZ_U8)0x03;
|
||||
qbSend[2] = (ZZ_U8)0xA8;
|
||||
}
|
||||
SendCommand(qbSend);
|
||||
return 0;
|
||||
}
|
||||
|
||||
int GY39Controller::GetHumiture(float &fTemp, float &fHum)
|
||||
{
|
||||
QByteArray qbSend,qbRecv;
|
||||
|
||||
qbSend.resize(3);
|
||||
qbSend[0] = (ZZ_U8)0xA5;
|
||||
qbSend[1] = (ZZ_U8)0x52;
|
||||
qbSend[2] = (ZZ_U8)0xF7;
|
||||
int iRes = SendCommand(qbSend);
|
||||
if (iRes)
|
||||
{
|
||||
return iRes;
|
||||
}
|
||||
|
||||
iRes = RecvHumitureData(qbRecv);
|
||||
if (iRes)
|
||||
{
|
||||
return iRes;
|
||||
}
|
||||
|
||||
ParseHumitureData(qbRecv);
|
||||
fTemp = m_fTemperature;
|
||||
fHum = m_fHumidity;
|
||||
return 0;
|
||||
}
|
23
source/Misc_Detector/GY39Controller.h
Normal file
23
source/Misc_Detector/GY39Controller.h
Normal file
@ -0,0 +1,23 @@
|
||||
#pragma once
|
||||
#include "pch.h"
|
||||
class GY39Controller :public QObject
|
||||
{
|
||||
Q_OBJECT
|
||||
public:
|
||||
GY39Controller(QObject* parent = nullptr);
|
||||
~GY39Controller();
|
||||
private:
|
||||
int SendCommand(QByteArray qbCommand);
|
||||
int RecvHumitureData(QByteArray &qbData);
|
||||
int ParseHumitureData(QByteArray &qbData);
|
||||
public:
|
||||
int Initialize(std::string ucPortName,bool bAuto15 = false,bool bAuto45 = false);
|
||||
int GetHumiture(float &fTemp, float &fHum);
|
||||
public slots:
|
||||
signals:
|
||||
|
||||
private:
|
||||
int m_iBaudRate;
|
||||
QSerialPort *m_pSerialPort;
|
||||
float m_fTemperature, m_fHumidity;
|
||||
};
|
Reference in New Issue
Block a user