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
#ifndef DLGSTP_H
#define DLGSTP_H

#include <QDialog>
#include <QGeoPositionInfoSource>
#include <QStandardItemModel>
#include <QUdpSocket>
#include <QSensor>
#include <functional>
QT_BEGIN_NAMESPACE
namespace Ui { class DlgSTP; }
QT_END_NAMESPACE

class DlgSTP : public QDialog
{
	Q_OBJECT
public:
	DlgSTP(QWidget *parent = nullptr);
	~DlgSTP();
	void EnumSensors();
	void openGPS();
protected:
	void timerEvent(QTimerEvent * evt) override;
private:
	Ui::DlgSTP *ui;
	QStandardItemModel * m_pMsgMod = 0;
	int m_nTimer = -1;
protected:
	//Sensors Update Lambdas
	QList<std::function<void (void)> > m_sensorUpdaters;
protected:
	//GPS
	QGeoPositionInfoSource *m_pos_source = 0;
protected:
	//Net Send
	QUdpSocket * m_psock = 0;
	QStringList m_listInfo;
};
#endif // DLGSTP_H

//cpp

DlgSTP::DlgSTP(QWidget *parent)
	: QDialog(parent)
	, ui(new Ui::DlgSTP)
	, m_pMsgMod(new QStandardItemModel(this))
	, m_psock(new QUdpSocket(this))
{
	ui->setupUi(this);
	ui->listView_msg->setModel(m_pMsgMod);
	showMaximized();
	//Open GPS Device
	openGPS();
	//Enum all sensors
	EnumSensors();
	loadSettings();
	m_nTimer = startTimer(20);
}

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
void DlgSTP::EnumSensors()
{
	QList<QByteArray> sensors = QSensor::sensorTypes();
	QString strSensors = "Sensors:n";
	for (QByteArray stp : sensors)
	{
		QSensor * sensor = new QSensor(stp);
		sensor->start();
		//添加界面刷新
		QListView * lstView = new QListView(this);
		QStandardItemModel * m_pMod = new QStandardItemModel(this);
		lstView->setModel(m_pMod);
		QString name = stp;
		ui->tabWidget->addTab(lstView,name);
		//设置刷新函数（供定时器调用）,使用Lamdba后期调用，省的建立函数了。
		m_sensorUpdaters<<[sensor,m_pMod,this,lstView,name](void)->void
		{
			QSensorReading *reading = sensor->reading();
			QString str = "SENSOR="+name + ";n";
			//获取当前传感器有多少数值
			int n = reading->valueCount();
			for (int i=0;i<n;++i)
			{
				QVariant vt = reading->value(i);
				str += QString("%1").arg(vt.toString());
			}
			//消息写入m_listInfo，后续发送
			m_listInfo << str;
			m_pMod->appendRow(new QStandardItem(str));
			lstView->scrollToBottom();
		};
	}
}

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
void DlgSTP::openGPS()
{
	m_pos_source = QGeoPositionInfoSource::createDefaultSource(0);
	if (m_pos_source)
	{
		//Add Tab
		QListView * lstView = new QListView(this);
		QStandardItemModel * m_pMod = new QStandardItemModel(this);
		lstView->setModel(m_pMod);
		ui->tabWidget->addTab(lstView,"GPS");
		//直接把GPS刷新信号绑定到Lambda
		connect (m_pos_source,
				 &QGeoPositionInfoSource::positionUpdated,
				 [lstView,m_pMod,this](const QGeoPositionInfo &update)->void
		{
			double lat = update.coordinate().latitude();
			double lon = update.coordinate().longitude();
			QDateTime dtm = update.timestamp();
			QString str = QString("SENSOR=GPS;nGMT_TIME=%1;nLAT=%2;nLON=%3;n")
					.arg(dtm.toString("yyyy-MM-dd HH:mm:ss"))
					.arg(lat,0,'f',7)
					.arg(lon,0,'f',7);
				//消息写入m_listInfo，后续发送
				m_listInfo << str;
			m_pMod->appendRow(new QStandardItem(str));
			lstView->scrollToBottom();
		});
		//即使出错了，也继续开始,把出错的信息绑定到Lambda
		connect (m_pos_source,
				 &QGeoPositionInfoSource::errorOccurred,
				 [this](QGeoPositionInfoSource::Error pe)->void{
			m_pos_source->startUpdates();
			m_pMsgMod->appendRow(new QStandardItem(QString("GPS Err Code %1.").arg(int(pe))));
		});
		//开启GPS
		m_pos_source->setUpdateInterval(ui->horizontalSlider_gps->value());
		m_pos_source->startUpdates();
	}
	else
		m_pMsgMod->appendRow(new QStandardItem("No GPS Found!"));
}

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
void  DlgSTP::timerEvent(QTimerEvent * evt)
{
	if (evt->timerId()==m_nTimer)
	{
		++m_clk;
		//UDP Send
		const int updateITV = ui->horizontalSlider_freq->value();
		const int updateGUI = (50 / (updateITV>50?50:updateITV) )* updateITV;
		if (m_clk % updateITV ==0 )
		{
			//调用各个Lambda刷新传感器，消息写入m_listInfo
			foreach(auto fn, m_sensorUpdaters)
				fn();
			//发送
			QHostAddress addr (ui->lineEdit_ip->text());
			int port = ui->spinBox_port->value();
			foreach(QString i, m_listInfo)
				m_psock->writeDatagram(i.toLocal8Bit(),addr,port);
			m_nTotalSent += m_listInfo.size();
			m_listInfo.clear();
			//适时更新界面
			if (m_clk % updateGUI==0)
			{
				m_pMsgMod->appendRow(new QStandardItem(QString("%1>%2 items sent.")
													   .arg(QDateTime::currentDateTime().toString("yyyy-MM-dd HH:mm:ss"))
													   .arg(m_nTotalSent)));
				if (m_pMsgMod->rowCount()>MAX_ROWS_LSTV)
					m_pMsgMod->removeRows(0,m_pMsgMod->rowCount()-MAX_ROWS_LSTV);
				ui->listView_msg->scrollToBottom();
			}
		}
	}
}