| 1 | /**************************************************************************** |
| 2 | ** |
| 3 | ** Copyright (C) 2016 The Qt Company Ltd. |
| 4 | ** Contact: https://www.qt.io/licensing/ |
| 5 | ** |
| 6 | ** This file is part of the QtPositioning module of the Qt Toolkit. |
| 7 | ** |
| 8 | ** $QT_BEGIN_LICENSE:LGPL$ |
| 9 | ** Commercial License Usage |
| 10 | ** Licensees holding valid commercial Qt licenses may use this file in |
| 11 | ** accordance with the commercial license agreement provided with the |
| 12 | ** Software or, alternatively, in accordance with the terms contained in |
| 13 | ** a written agreement between you and The Qt Company. For licensing terms |
| 14 | ** and conditions see https://www.qt.io/terms-conditions. For further |
| 15 | ** information use the contact form at https://www.qt.io/contact-us. |
| 16 | ** |
| 17 | ** GNU Lesser General Public License Usage |
| 18 | ** Alternatively, this file may be used under the terms of the GNU Lesser |
| 19 | ** General Public License version 3 as published by the Free Software |
| 20 | ** Foundation and appearing in the file LICENSE.LGPL3 included in the |
| 21 | ** packaging of this file. Please review the following information to |
| 22 | ** ensure the GNU Lesser General Public License version 3 requirements |
| 23 | ** will be met: https://www.gnu.org/licenses/lgpl-3.0.html. |
| 24 | ** |
| 25 | ** GNU General Public License Usage |
| 26 | ** Alternatively, this file may be used under the terms of the GNU |
| 27 | ** General Public License version 2.0 or (at your option) the GNU General |
| 28 | ** Public license version 3 or any later version approved by the KDE Free |
| 29 | ** Qt Foundation. The licenses are as published by the Free Software |
| 30 | ** Foundation and appearing in the file LICENSE.GPL2 and LICENSE.GPL3 |
| 31 | ** included in the packaging of this file. Please review the following |
| 32 | ** information to ensure the GNU General Public License requirements will |
| 33 | ** be met: https://www.gnu.org/licenses/gpl-2.0.html and |
| 34 | ** https://www.gnu.org/licenses/gpl-3.0.html. |
| 35 | ** |
| 36 | ** $QT_END_LICENSE$ |
| 37 | ** |
| 38 | ****************************************************************************/ |
| 39 | |
| 40 | #include "qgeopositioninfosourcefactory_serialnmea.h" |
| 41 | #include <QtPositioning/qnmeapositioninfosource.h> |
| 42 | #include <QtSerialPort/qserialport.h> |
| 43 | #include <QtSerialPort/qserialportinfo.h> |
| 44 | #include <QtCore/qloggingcategory.h> |
| 45 | #include <QSet> |
| 46 | #include "qiopipe_p.h" |
| 47 | #include <QSharedPointer> |
| 48 | #include "qnmeasatelliteinfosource_p.h" |
| 49 | |
| 50 | Q_LOGGING_CATEGORY(lcSerial, "qt.positioning.serialnmea" ) |
| 51 | |
| 52 | class IODeviceContainer |
| 53 | { |
| 54 | public: |
| 55 | IODeviceContainer() {} |
| 56 | IODeviceContainer(IODeviceContainer const&) = delete; |
| 57 | void operator=(IODeviceContainer const&) = delete; |
| 58 | |
| 59 | QSharedPointer<QIOPipe> serial(const QString &portName) |
| 60 | { |
| 61 | if (m_serialPorts.contains(akey: portName)) { |
| 62 | m_serialPorts[portName].refs++; |
| 63 | QIOPipe *endPipe = new QIOPipe(m_serialPorts[portName].proxy); |
| 64 | m_serialPorts[portName].proxy->addChildPipe(childPipe: endPipe); |
| 65 | return QSharedPointer<QIOPipe>(endPipe); |
| 66 | } |
| 67 | IODevice device; |
| 68 | QSerialPort *port = new QSerialPort(portName); |
| 69 | port->setBaudRate(baudRate: 4800); |
| 70 | qCDebug(lcSerial) << "Opening serial port" << portName; |
| 71 | if (!port->open(mode: QIODevice::ReadOnly)) { |
| 72 | qWarning(msg: "serialnmea: Failed to open %s" , qPrintable(portName)); |
| 73 | delete port; |
| 74 | return {}; |
| 75 | } |
| 76 | qCDebug(lcSerial) << "Opened successfully" ; |
| 77 | device.device = port; |
| 78 | device.refs = 1; |
| 79 | device.proxy = new QIOPipe(port, QIOPipe::ProxyPipe); |
| 80 | m_serialPorts[portName] = device; |
| 81 | QIOPipe *endPipe = new QIOPipe(device.proxy); |
| 82 | device.proxy->addChildPipe(childPipe: endPipe); |
| 83 | return QSharedPointer<QIOPipe>(endPipe); |
| 84 | } |
| 85 | |
| 86 | void releaseSerial(const QString &portName, QSharedPointer<QIOPipe> &pipe) { |
| 87 | if (!m_serialPorts.contains(akey: portName)) |
| 88 | return; |
| 89 | |
| 90 | pipe.clear(); // make sure to release the pipe returned by getSerial, or else, if there are still refs, data will be leaked through it |
| 91 | IODevice &device = m_serialPorts[portName]; |
| 92 | if (device.refs > 1) { |
| 93 | device.refs--; |
| 94 | return; |
| 95 | } |
| 96 | |
| 97 | IODevice taken = m_serialPorts.take(akey: portName); |
| 98 | taken.device->deleteLater(); |
| 99 | } |
| 100 | |
| 101 | private: |
| 102 | |
| 103 | struct IODevice { |
| 104 | QIODevice *device = nullptr; |
| 105 | QIOPipe *proxy = nullptr; // adding client pipes as children of proxy allows to dynamically add clients to one device. |
| 106 | unsigned int refs = 1; |
| 107 | }; |
| 108 | |
| 109 | QMap<QString, IODevice> m_serialPorts; |
| 110 | }; |
| 111 | |
| 112 | Q_GLOBAL_STATIC(IODeviceContainer, deviceContainer) |
| 113 | |
| 114 | |
| 115 | class NmeaSource : public QNmeaPositionInfoSource |
| 116 | { |
| 117 | public: |
| 118 | explicit NmeaSource(QObject *parent, const QVariantMap ¶meters); |
| 119 | ~NmeaSource() override; |
| 120 | bool isValid() const { return !m_port.isNull(); } |
| 121 | |
| 122 | private: |
| 123 | QSharedPointer<QIOPipe> m_port; |
| 124 | QString m_portName; |
| 125 | }; |
| 126 | |
| 127 | NmeaSource::NmeaSource(QObject *parent, const QVariantMap ¶meters) |
| 128 | : QNmeaPositionInfoSource(RealTimeMode, parent) |
| 129 | { |
| 130 | QByteArray requestedPort; |
| 131 | if (parameters.contains(QStringLiteral("serialnmea.serial_port" ))) |
| 132 | requestedPort = parameters.value(QStringLiteral("serialnmea.serial_port" )).toString().toLatin1(); |
| 133 | else |
| 134 | requestedPort = qgetenv(varName: "QT_NMEA_SERIAL_PORT" ); |
| 135 | QString portName; |
| 136 | if (requestedPort.isEmpty()) { |
| 137 | const QList<QSerialPortInfo> ports = QSerialPortInfo::availablePorts(); |
| 138 | qCDebug(lcSerial) << "Found" << ports.count() << "serial ports" ; |
| 139 | if (ports.isEmpty()) { |
| 140 | qWarning(msg: "serialnmea: No serial ports found" ); |
| 141 | return; |
| 142 | } |
| 143 | |
| 144 | // Try to find a well-known device. |
| 145 | QSet<int> supportedDevices; |
| 146 | supportedDevices << 0x67b; // GlobalSat (BU-353S4 and probably others) |
| 147 | supportedDevices << 0xe8d; // Qstarz MTK II |
| 148 | for (const QSerialPortInfo& port : ports) { |
| 149 | if (port.hasVendorIdentifier() && supportedDevices.contains(value: port.vendorIdentifier())) { |
| 150 | portName = port.portName(); |
| 151 | break; |
| 152 | } |
| 153 | } |
| 154 | |
| 155 | if (portName.isEmpty()) { |
| 156 | qWarning(msg: "serialnmea: No known GPS device found. Specify the COM port via QT_NMEA_SERIAL_PORT." ); |
| 157 | return; |
| 158 | } |
| 159 | m_portName = portName; |
| 160 | } else { |
| 161 | m_portName = QString::fromUtf8(str: requestedPort); |
| 162 | } |
| 163 | |
| 164 | m_port = deviceContainer->serial(portName: m_portName); |
| 165 | if (!m_port) |
| 166 | return; |
| 167 | |
| 168 | setDevice(m_port.data()); |
| 169 | } |
| 170 | |
| 171 | NmeaSource::~NmeaSource() |
| 172 | { |
| 173 | deviceContainer->releaseSerial(portName: m_portName, pipe&: m_port); |
| 174 | } |
| 175 | |
| 176 | |
| 177 | |
| 178 | class NmeaSatelliteSource : public QNmeaSatelliteInfoSource |
| 179 | { |
| 180 | public: |
| 181 | NmeaSatelliteSource(QObject *parent, const QVariantMap ¶meters) |
| 182 | : QNmeaSatelliteInfoSource(parent) |
| 183 | { |
| 184 | QByteArray requestedPort; |
| 185 | if (parameters.contains(QStringLiteral("serialnmea.serial_port" ))) |
| 186 | requestedPort = parameters.value(QStringLiteral("serialnmea.serial_port" )).toString().toLatin1(); |
| 187 | else |
| 188 | requestedPort = qgetenv(varName: "QT_NMEA_SERIAL_PORT" ); |
| 189 | QString portName; |
| 190 | if (requestedPort.isEmpty()) { |
| 191 | const QList<QSerialPortInfo> ports = QSerialPortInfo::availablePorts(); |
| 192 | qCDebug(lcSerial) << "Found" << ports.count() << "serial ports" ; |
| 193 | if (ports.isEmpty()) { |
| 194 | qWarning(msg: "serialnmea: No serial ports found" ); |
| 195 | return; |
| 196 | } |
| 197 | |
| 198 | // Try to find a well-known device. |
| 199 | QSet<int> supportedDevices; |
| 200 | supportedDevices << 0x67b; // GlobalSat (BU-353S4 and probably others) |
| 201 | supportedDevices << 0xe8d; // Qstarz MTK II |
| 202 | foreach (const QSerialPortInfo& port, ports) { |
| 203 | if (port.hasVendorIdentifier() && supportedDevices.contains(value: port.vendorIdentifier())) { |
| 204 | portName = port.portName(); |
| 205 | break; |
| 206 | } |
| 207 | } |
| 208 | |
| 209 | if (portName.isEmpty()) { |
| 210 | qWarning(msg: "serialnmea: No known GPS device found. Specify the COM port via QT_NMEA_SERIAL_PORT." ); |
| 211 | return; |
| 212 | } |
| 213 | m_portName = portName; |
| 214 | } else { |
| 215 | m_portName = QString::fromUtf8(str: requestedPort); |
| 216 | } |
| 217 | |
| 218 | m_port = deviceContainer->serial(portName: m_portName); |
| 219 | if (!m_port) |
| 220 | return; |
| 221 | |
| 222 | setDevice(m_port.data()); |
| 223 | } |
| 224 | |
| 225 | ~NmeaSatelliteSource() |
| 226 | { |
| 227 | deviceContainer->releaseSerial(portName: m_portName, pipe&: m_port); |
| 228 | } |
| 229 | |
| 230 | bool isValid() const { return !m_port.isNull(); } |
| 231 | |
| 232 | private: |
| 233 | QSharedPointer<QIOPipe> m_port; |
| 234 | QString m_portName; |
| 235 | }; |
| 236 | |
| 237 | QGeoPositionInfoSource *QGeoPositionInfoSourceFactorySerialNmea::positionInfoSource(QObject *parent) |
| 238 | { |
| 239 | return positionInfoSourceWithParameters(parent, parameters: QVariantMap()); |
| 240 | } |
| 241 | |
| 242 | QGeoSatelliteInfoSource *QGeoPositionInfoSourceFactorySerialNmea::satelliteInfoSource(QObject *parent) |
| 243 | { |
| 244 | return satelliteInfoSourceWithParameters(parent, parameters: QVariantMap()); |
| 245 | } |
| 246 | |
| 247 | QGeoAreaMonitorSource *QGeoPositionInfoSourceFactorySerialNmea::areaMonitor(QObject *parent) |
| 248 | { |
| 249 | return areaMonitorWithParameters(parent, parameters: QVariantMap()); |
| 250 | } |
| 251 | |
| 252 | QGeoPositionInfoSource *QGeoPositionInfoSourceFactorySerialNmea::positionInfoSourceWithParameters(QObject *parent, const QVariantMap ¶meters) |
| 253 | { |
| 254 | QScopedPointer<NmeaSource> src(new NmeaSource(parent, parameters)); |
| 255 | return src->isValid() ? src.take() : nullptr; |
| 256 | } |
| 257 | |
| 258 | QGeoSatelliteInfoSource *QGeoPositionInfoSourceFactorySerialNmea::satelliteInfoSourceWithParameters(QObject *parent, const QVariantMap ¶meters) |
| 259 | { |
| 260 | QScopedPointer<NmeaSatelliteSource> src(new NmeaSatelliteSource(parent, parameters)); |
| 261 | return src->isValid() ? src.take() : nullptr; |
| 262 | } |
| 263 | |
| 264 | QGeoAreaMonitorSource *QGeoPositionInfoSourceFactorySerialNmea::areaMonitorWithParameters(QObject *parent, const QVariantMap ¶meters) |
| 265 | { |
| 266 | Q_UNUSED(parent); |
| 267 | Q_UNUSED(parameters) |
| 268 | return nullptr; |
| 269 | } |
| 270 | |