mirror of
https://github.com/f4exb/sdrangel.git
synced 2024-11-08 17:46:03 -05:00
682 lines
24 KiB
C++
682 lines
24 KiB
C++
///////////////////////////////////////////////////////////////////////////////////
|
|
// Copyright (C) 2021 Jon Beniston, M7RCE //
|
|
// Copyright (C) 2020 Edouard Griffiths, F4EXB //
|
|
// //
|
|
// This program is free software; you can redistribute it and/or modify //
|
|
// it under the terms of the GNU General Public License as published by //
|
|
// the Free Software Foundation as version 3 of the License, or //
|
|
// (at your option) any later version. //
|
|
// //
|
|
// This program is distributed in the hope that it will be useful, //
|
|
// but WITHOUT ANY WARRANTY; without even the implied warranty of //
|
|
// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the //
|
|
// GNU General Public License V3 for more details. //
|
|
// //
|
|
// You should have received a copy of the GNU General Public License //
|
|
// along with this program. If not, see <http://www.gnu.org/licenses/>. //
|
|
///////////////////////////////////////////////////////////////////////////////////
|
|
|
|
#include <cmath>
|
|
|
|
#include <QDebug>
|
|
#include <QAbstractSocket>
|
|
#include <QTcpServer>
|
|
#include <QTcpSocket>
|
|
#include <QEventLoop>
|
|
#include <QTimer>
|
|
#include <QDateTime>
|
|
|
|
#include "SWGTargetAzimuthElevation.h"
|
|
#include "SWGMapItem.h"
|
|
#include "SWGStarTrackerTarget.h"
|
|
|
|
#include "webapi/webapiadapterinterface.h"
|
|
#include "webapi/webapiutils.h"
|
|
|
|
#include "util/units.h"
|
|
#include "maincore.h"
|
|
|
|
#include "startracker.h"
|
|
#include "startrackerworker.h"
|
|
#include "startrackerreport.h"
|
|
|
|
MESSAGE_CLASS_DEFINITION(StarTrackerWorker::MsgConfigureStarTrackerWorker, Message)
|
|
MESSAGE_CLASS_DEFINITION(StarTrackerReport::MsgReportAzAl, Message)
|
|
MESSAGE_CLASS_DEFINITION(StarTrackerReport::MsgReportRADec, Message)
|
|
MESSAGE_CLASS_DEFINITION(StarTrackerReport::MsgReportGalactic, Message)
|
|
|
|
StarTrackerWorker::StarTrackerWorker(StarTracker* starTracker, WebAPIAdapterInterface *webAPIAdapterInterface) :
|
|
m_starTracker(starTracker),
|
|
m_webAPIAdapterInterface(webAPIAdapterInterface),
|
|
m_msgQueueToFeature(nullptr),
|
|
m_msgQueueToGUI(nullptr),
|
|
m_running(false),
|
|
m_pollTimer(this),
|
|
m_tcpServer(nullptr),
|
|
m_clientConnection(nullptr),
|
|
m_solarFlux(0.0f)
|
|
{
|
|
connect(&m_pollTimer, SIGNAL(timeout()), this, SLOT(update()));
|
|
}
|
|
|
|
StarTrackerWorker::~StarTrackerWorker()
|
|
{
|
|
m_inputMessageQueue.clear();
|
|
}
|
|
|
|
void StarTrackerWorker::reset()
|
|
{
|
|
QMutexLocker mutexLocker(&m_mutex);
|
|
m_inputMessageQueue.clear();
|
|
}
|
|
|
|
bool StarTrackerWorker::startWork()
|
|
{
|
|
QMutexLocker mutexLocker(&m_mutex);
|
|
connect(&m_inputMessageQueue, SIGNAL(messageEnqueued()), this, SLOT(handleInputMessages()));
|
|
connect(thread(), SIGNAL(started()), this, SLOT(started()));
|
|
connect(thread(), SIGNAL(finished()), this, SLOT(finished()));
|
|
m_running = true;
|
|
return m_running;
|
|
}
|
|
|
|
// startWork() is called from main thread. Timers/sockets need to be started on worker thread
|
|
void StarTrackerWorker::started()
|
|
{
|
|
m_pollTimer.start((int)round(m_settings.m_updatePeriod*1000.0));
|
|
disconnect(thread(), SIGNAL(started()), this, SLOT(started()));
|
|
}
|
|
|
|
void StarTrackerWorker::stopWork()
|
|
{
|
|
QMutexLocker mutexLocker(&m_mutex);
|
|
disconnect(&m_inputMessageQueue, SIGNAL(messageEnqueued()), this, SLOT(handleInputMessages()));
|
|
}
|
|
|
|
void StarTrackerWorker::finished()
|
|
{
|
|
restartServer(false, 0);
|
|
m_pollTimer.stop();
|
|
disconnect(thread(), SIGNAL(finished()), this, SLOT(finished()));
|
|
m_running = false;
|
|
}
|
|
|
|
void StarTrackerWorker::handleInputMessages()
|
|
{
|
|
Message* message;
|
|
|
|
while ((message = m_inputMessageQueue.pop()) != nullptr)
|
|
{
|
|
if (handleMessage(*message)) {
|
|
delete message;
|
|
}
|
|
}
|
|
}
|
|
|
|
bool StarTrackerWorker::handleMessage(const Message& cmd)
|
|
{
|
|
if (MsgConfigureStarTrackerWorker::match(cmd))
|
|
{
|
|
QMutexLocker mutexLocker(&m_mutex);
|
|
MsgConfigureStarTrackerWorker& cfg = (MsgConfigureStarTrackerWorker&) cmd;
|
|
|
|
applySettings(cfg.getSettings(), cfg.getForce());
|
|
return true;
|
|
}
|
|
else if (StarTracker::MsgSetSolarFlux::match(cmd))
|
|
{
|
|
StarTracker::MsgSetSolarFlux& msg = (StarTracker::MsgSetSolarFlux&) cmd;
|
|
m_solarFlux = msg.getFlux();
|
|
return true;
|
|
}
|
|
else
|
|
{
|
|
return false;
|
|
}
|
|
}
|
|
|
|
void StarTrackerWorker::applySettings(const StarTrackerSettings& settings, bool force)
|
|
{
|
|
qDebug() << "StarTrackerWorker::applySettings:"
|
|
<< " m_target: " << settings.m_target
|
|
<< " m_ra: " << settings.m_ra
|
|
<< " m_dec: " << settings.m_dec
|
|
<< " m_time: " << settings.m_dateTime
|
|
<< " m_enableServer: " << settings.m_enableServer
|
|
<< " m_serverPort: " << settings.m_serverPort
|
|
<< " m_updatePeriod: " << settings.m_updatePeriod
|
|
<< " force: " << force;
|
|
|
|
if ( (m_settings.m_ra != settings.m_ra)
|
|
|| (m_settings.m_dec != settings.m_dec)
|
|
|| (m_settings.m_latitude != settings.m_latitude)
|
|
|| (m_settings.m_longitude != settings.m_longitude)
|
|
|| (m_settings.m_target != settings.m_target)
|
|
|| (m_settings.m_dateTime != settings.m_dateTime)
|
|
|| (m_settings.m_refraction != settings.m_refraction)
|
|
|| (m_settings.m_pressure != settings.m_pressure)
|
|
|| (m_settings.m_temperature != settings.m_temperature)
|
|
|| (m_settings.m_humidity != settings.m_humidity)
|
|
|| (m_settings.m_heightAboveSeaLevel != settings.m_heightAboveSeaLevel)
|
|
|| (m_settings.m_temperatureLapseRate != settings.m_temperatureLapseRate)
|
|
|| (m_settings.m_frequency != settings.m_frequency)
|
|
|| (m_settings.m_beamwidth != settings.m_beamwidth)
|
|
|| (m_settings.m_az != settings.m_az)
|
|
|| (m_settings.m_el != settings.m_el)
|
|
|| (m_settings.m_l != settings.m_l)
|
|
|| (m_settings.m_b != settings.m_b)
|
|
|| (m_settings.m_azOffset != settings.m_azOffset)
|
|
|| (m_settings.m_elOffset != settings.m_elOffset)
|
|
|| force)
|
|
{
|
|
// Recalculate immediately
|
|
QTimer::singleShot(1, this, &StarTrackerWorker::update);
|
|
m_pollTimer.start((int)round(settings.m_updatePeriod*1000.0));
|
|
}
|
|
else if ((m_settings.m_updatePeriod != settings.m_updatePeriod) || force)
|
|
{
|
|
m_pollTimer.start((int)round(settings.m_updatePeriod*1000.0));
|
|
}
|
|
|
|
if (!settings.m_drawSunOnMap && m_settings.m_drawSunOnMap)
|
|
removeFromMap("Sun");
|
|
if (!settings.m_drawMoonOnMap && m_settings.m_drawMoonOnMap)
|
|
removeFromMap("Moon");
|
|
if ((!settings.m_drawStarOnMap && m_settings.m_drawStarOnMap)
|
|
|| (((settings.m_target == "Sun") || (settings.m_target == "Moon"))
|
|
&& ((m_settings.m_target != "Sun") && (m_settings.m_target != "Moon"))))
|
|
removeFromMap("Star");
|
|
|
|
if ((settings.m_serverPort != m_settings.m_serverPort) ||
|
|
(settings.m_enableServer != m_settings.m_enableServer) || force)
|
|
{
|
|
restartServer(settings.m_enableServer, settings.m_serverPort);
|
|
}
|
|
|
|
m_settings = settings;
|
|
}
|
|
|
|
void StarTrackerWorker::restartServer(bool enabled, uint32_t port)
|
|
{
|
|
if (m_tcpServer)
|
|
{
|
|
if (m_clientConnection)
|
|
{
|
|
m_clientConnection->close();
|
|
delete m_clientConnection;
|
|
m_clientConnection = nullptr;
|
|
}
|
|
|
|
disconnect(m_tcpServer, &QTcpServer::newConnection, this, &StarTrackerWorker::acceptConnection);
|
|
m_tcpServer->close();
|
|
delete m_tcpServer;
|
|
m_tcpServer = nullptr;
|
|
}
|
|
|
|
if (enabled)
|
|
{
|
|
qDebug() << "StarTrackerWorker::restartServer: server enabled on port " << port;
|
|
m_tcpServer = new QTcpServer(this);
|
|
|
|
if (!m_tcpServer->listen(QHostAddress::Any, port)) {
|
|
qWarning("Star Tracker failed to listen on port %u. Check it is not already in use.", port);
|
|
} else {
|
|
connect(m_tcpServer, &QTcpServer::newConnection, this, &StarTrackerWorker::acceptConnection);
|
|
}
|
|
}
|
|
}
|
|
|
|
void StarTrackerWorker::acceptConnection()
|
|
{
|
|
QMutexLocker mutexLocker(&m_mutex);
|
|
m_clientConnection = m_tcpServer->nextPendingConnection();
|
|
|
|
if (!m_clientConnection) {
|
|
return;
|
|
}
|
|
|
|
connect(m_clientConnection, &QIODevice::readyRead, this, &StarTrackerWorker::readStellariumCommand);
|
|
connect(m_clientConnection, SIGNAL(disconnected()), this, SLOT(disconnected()));
|
|
#if QT_VERSION < QT_VERSION_CHECK(5, 15, 0)
|
|
connect(m_clientConnection, QOverload<QAbstractSocket::SocketError>::of(&QAbstractSocket::error), this, &StarTrackerWorker::errorOccurred);
|
|
#else
|
|
connect(m_clientConnection, &QAbstractSocket::errorOccurred, this, &StarTrackerWorker::errorOccurred);
|
|
#endif
|
|
qDebug() << "StarTrackerWorker::acceptConnection: client connected";
|
|
}
|
|
|
|
void StarTrackerWorker::disconnected()
|
|
{
|
|
QMutexLocker mutexLocker(&m_mutex);
|
|
qDebug() << "StarTrackerWorker::disconnected";
|
|
m_clientConnection->deleteLater();
|
|
m_clientConnection = nullptr;
|
|
/*if (m_msgQueueToFeature)
|
|
{
|
|
StarTrackerWorker::MsgReportWorker *msg = StarTrackerWorker::MsgReportWorker::create("Disconnected");
|
|
m_msgQueueToFeature->push(msg);
|
|
}*/
|
|
}
|
|
|
|
void StarTrackerWorker::errorOccurred(QAbstractSocket::SocketError socketError)
|
|
{
|
|
qDebug() << "StarTrackerWorker::errorOccurred: " << socketError;
|
|
/*if (m_msgQueueToFeature)
|
|
{
|
|
StarTrackerWorker::MsgReportWorker *msg = StarTrackerWorker::MsgReportWorker::create(m_socket.errorString() + " " + socketError);
|
|
m_msgQueueToFeature->push(msg);
|
|
}*/
|
|
}
|
|
|
|
// Get RA & Dec from Stellarium
|
|
// Protocol described here:
|
|
// http://svn.code.sf.net/p/stellarium/code/trunk/telescope_server/stellarium_telescope_protocol.txt
|
|
void StarTrackerWorker::readStellariumCommand()
|
|
{
|
|
QMutexLocker mutexLocker(&m_mutex);
|
|
|
|
unsigned char buf[64];
|
|
qint64 len;
|
|
|
|
len = m_clientConnection->read((char *)buf, sizeof(buf));
|
|
if (len != -1)
|
|
{
|
|
int msg_len;
|
|
int msg_type;
|
|
unsigned char *msg;
|
|
|
|
// Extract length and message type
|
|
msg_len = buf[0] | (buf[1] << 8);
|
|
msg_type = buf[2] | (buf[3] << 8);
|
|
msg = &buf[4];
|
|
|
|
if (msg_type == 0) // MessageGoto
|
|
{
|
|
unsigned ra;
|
|
int dec;
|
|
|
|
if (msg_len == 20)
|
|
{
|
|
// Skip time
|
|
msg += 8;
|
|
// Extract RA LSB first
|
|
ra = msg[0] | (msg[1] << 8) | (msg[2] << 16) | (msg[3] << 24);
|
|
msg += 4;
|
|
// Extract DEC LSB first
|
|
dec = msg[0] | (msg[1] << 8) | (msg[2] << 16) | (msg[3] << 24);
|
|
msg += 4;
|
|
|
|
// Convert from integer to floating point
|
|
double raDeg = ra*(24.0/4294967296.0); // Convert to decimal hours
|
|
double decDeg = dec*(360.0/4294967296.0); // Convert to decimal degrees
|
|
|
|
// Set as current target
|
|
m_settings.m_ra = Units::decimalHoursToHoursMinutesAndSeconds(raDeg);
|
|
m_settings.m_dec = Units::decimalDegreesToDegreeMinutesAndSeconds(decDeg);
|
|
|
|
qDebug() << "StarTrackerWorker: New target from Stellarum: " << m_settings.m_ra << " " << m_settings.m_dec;
|
|
|
|
// Forward to GUI for display
|
|
if (getMessageQueueToGUI()) {
|
|
getMessageQueueToGUI()->push(StarTrackerReport::MsgReportRADec::create(raDeg, decDeg, "target"));
|
|
}
|
|
}
|
|
else
|
|
{
|
|
qDebug() << "StarTrackerWorker: Unexpected number of bytes received (" << len << ") for message type: " << msg_type;
|
|
}
|
|
}
|
|
else
|
|
{
|
|
qDebug() << "StarTrackerWorker: Unsupported Stellarium message type: " << msg_type;
|
|
}
|
|
}
|
|
}
|
|
|
|
// Send our target to Stellarium (J2000 epoch)
|
|
void StarTrackerWorker::writeStellariumTarget(double ra, double dec)
|
|
{
|
|
QMutexLocker mutexLocker(&m_mutex);
|
|
|
|
if (m_clientConnection != nullptr)
|
|
{
|
|
unsigned char buf[24];
|
|
|
|
// Length
|
|
buf[0] = sizeof(buf);
|
|
buf[1] = 0;
|
|
// Type (MessageCurrentPosition)
|
|
buf[2] = 0;
|
|
buf[3] = 0;
|
|
// Time (unused)
|
|
buf[4] = 0;
|
|
buf[5] = 0;
|
|
buf[6] = 0;
|
|
buf[7] = 0;
|
|
buf[8] = 0;
|
|
buf[9] = 0;
|
|
buf[10] = 0;
|
|
buf[11] = 0;
|
|
// RA
|
|
unsigned raInt = ra * (4294967296.0/24.0);
|
|
buf[12] = raInt & 0xff;
|
|
buf[13] = (raInt >> 8) & 0xff;
|
|
buf[14] = (raInt >> 16) & 0xff;
|
|
buf[15] = (raInt >> 24) & 0xff;
|
|
// Dec
|
|
int decInt = dec * (4294967296.0/360.0);
|
|
buf[16] = decInt & 0xff;
|
|
buf[17] = (decInt >> 8) & 0xff;
|
|
buf[18] = (decInt >> 16) & 0xff;
|
|
buf[19] = (decInt >> 24) & 0xff;
|
|
// Status (OK)
|
|
buf[20] = 0;
|
|
buf[21] = 0;
|
|
buf[22] = 0;
|
|
buf[23] = 0;
|
|
|
|
m_clientConnection->write((char *)buf, sizeof(buf));
|
|
}
|
|
}
|
|
|
|
|
|
void StarTrackerWorker::updateRaDec(RADec rd, QDateTime dt, bool lbTarget)
|
|
{
|
|
RADec rdJ2000;
|
|
double jd;
|
|
|
|
jd = Astronomy::julianDate(dt);
|
|
// Precess to J2000
|
|
rdJ2000 = Astronomy::precess(rd, jd, Astronomy::jd_j2000());
|
|
// Send to Stellarium
|
|
writeStellariumTarget(rdJ2000.ra, rdJ2000.dec);
|
|
// Send to GUI
|
|
if (m_settings.m_target == "Sun" || m_settings.m_target == "Moon" || (m_settings.m_target == "Custom Az/El") || lbTarget)
|
|
{
|
|
if (getMessageQueueToGUI())
|
|
{
|
|
if (m_settings.m_jnow) {
|
|
getMessageQueueToGUI()->push(StarTrackerReport::MsgReportRADec::create(rd.ra, rd.dec, "target"));
|
|
} else {
|
|
getMessageQueueToGUI()->push(StarTrackerReport::MsgReportRADec::create(rdJ2000.ra, rdJ2000.dec, "target"));
|
|
}
|
|
}
|
|
}
|
|
}
|
|
|
|
void StarTrackerWorker::removeFromMap(QString id)
|
|
{
|
|
QList<ObjectPipe*> mapMessagePipes;
|
|
MainCore::instance()->getMessagePipes().getMessagePipes(m_starTracker, "mapitems", mapMessagePipes);
|
|
|
|
if (mapMessagePipes.size() > 0) {
|
|
sendToMap(mapMessagePipes, id, "", "", 0.0, 0.0);
|
|
}
|
|
}
|
|
|
|
void StarTrackerWorker::sendToMap(
|
|
const QList<ObjectPipe*>& mapMessagePipes,
|
|
QString name,
|
|
QString image,
|
|
QString text,
|
|
double lat,
|
|
double lon,
|
|
double rotation
|
|
)
|
|
{
|
|
for (const auto& pipe : mapMessagePipes)
|
|
{
|
|
MessageQueue *messageQueue = qobject_cast<MessageQueue*>(pipe->m_element);
|
|
SWGSDRangel::SWGMapItem *swgMapItem = new SWGSDRangel::SWGMapItem();
|
|
swgMapItem->setName(new QString(name));
|
|
swgMapItem->setLatitude(lat);
|
|
swgMapItem->setLongitude(lon);
|
|
swgMapItem->setImage(new QString(image));
|
|
swgMapItem->setImageRotation(rotation);
|
|
swgMapItem->setText(new QString(text));
|
|
|
|
MainCore::MsgMapItem *msg = MainCore::MsgMapItem::create(m_starTracker, swgMapItem);
|
|
messageQueue->push(msg);
|
|
}
|
|
}
|
|
|
|
QString moonPhase(double sunLongitude, double moonLongitude, double observationLatitude, double &rotation)
|
|
{
|
|
double difference = sunLongitude - moonLongitude;
|
|
if (difference < -180.0)
|
|
difference += 360.0;
|
|
else if (difference > 180.0)
|
|
difference -= 360.0;
|
|
|
|
if (difference >= 0.0)
|
|
rotation = observationLatitude - 90.0;
|
|
else
|
|
rotation = 90.0 - observationLatitude;
|
|
|
|
// These probably shouldn't be divided equally
|
|
if (difference < -157.5)
|
|
return "full";
|
|
else if (difference < -112.5)
|
|
return "waxing-gibbous";
|
|
else if (difference < -67.5)
|
|
return "first-quarter";
|
|
else if (difference < -22.5)
|
|
return "waxing-crescent";
|
|
else if (difference < 22.5)
|
|
return "new";
|
|
else if (difference < 67.5)
|
|
return "waning-crescent";
|
|
else if (difference < 112.5)
|
|
return "third-quarter";
|
|
else if (difference < 157.5)
|
|
return "waning-gibbous";
|
|
else if (difference < 202.5)
|
|
return "full";
|
|
else
|
|
return "full";
|
|
}
|
|
|
|
void StarTrackerWorker::update()
|
|
{
|
|
AzAlt aa, sunAA, moonAA;
|
|
RADec rd, sunRD, moonRD;
|
|
double l, b;
|
|
bool lbTarget = false;
|
|
|
|
QDateTime dt;
|
|
|
|
// Get date and time to calculate position at
|
|
if (m_settings.m_dateTime == "") {
|
|
dt = QDateTime::currentDateTime();
|
|
} else {
|
|
dt = QDateTime::fromString(m_settings.m_dateTime, Qt::ISODateWithMs);
|
|
}
|
|
|
|
// Calculate position
|
|
if ((m_settings.m_target == "Sun") || m_settings.m_drawSunOnMap || m_settings.m_drawSunOnSkyTempChart)
|
|
{
|
|
Astronomy::sunPosition(sunAA, sunRD, m_settings.m_latitude, m_settings.m_longitude, dt);
|
|
getMessageQueueToGUI()->push(StarTrackerReport::MsgReportRADec::create(sunRD.ra, sunRD.dec, "sun"));
|
|
}
|
|
if ((m_settings.m_target == "Moon") || m_settings.m_drawMoonOnMap || m_settings.m_drawMoonOnSkyTempChart)
|
|
{
|
|
Astronomy::moonPosition(moonAA, moonRD, m_settings.m_latitude, m_settings.m_longitude, dt);
|
|
getMessageQueueToGUI()->push(StarTrackerReport::MsgReportRADec::create(moonRD.ra, moonRD.dec, "moon"));
|
|
}
|
|
|
|
if (m_settings.m_target == "Sun")
|
|
{
|
|
rd = sunRD;
|
|
aa = sunAA;
|
|
Astronomy::equatorialToGalactic(rd.ra, rd.dec, l, b);
|
|
}
|
|
else if (m_settings.m_target == "Moon")
|
|
{
|
|
rd = moonRD;
|
|
aa = moonAA;
|
|
Astronomy::equatorialToGalactic(rd.ra, rd.dec, l, b);
|
|
}
|
|
else if (m_settings.m_target == "Custom Az/El")
|
|
{
|
|
// Convert Alt/Az to RA/Dec
|
|
aa.alt = m_settings.m_el;
|
|
aa.az = m_settings.m_az;
|
|
rd = Astronomy::azAltToRaDec(aa, m_settings.m_latitude, m_settings.m_longitude, dt);
|
|
// Precess RA/DEC from Jnow to J2000
|
|
RADec rd2000 = Astronomy::precess(rd, Astronomy::julianDate(dt), Astronomy::jd_j2000());
|
|
// Convert to l/b
|
|
Astronomy::equatorialToGalactic(rd2000.ra, rd2000.dec, l, b);
|
|
if (!m_settings.m_jnow) {
|
|
rd = rd2000;
|
|
}
|
|
}
|
|
else if ( (m_settings.m_target == "Custom l/b")
|
|
|| (m_settings.m_target == "S7")
|
|
|| (m_settings.m_target == "S8")
|
|
|| (m_settings.m_target == "S9")
|
|
)
|
|
{
|
|
// Convert l/b to RA/Dec, then Alt/Az
|
|
l = m_settings.m_l;
|
|
b = m_settings.m_b;
|
|
Astronomy::galacticToEquatorial(l, b, rd.ra, rd.dec);
|
|
aa = Astronomy::raDecToAzAlt(rd, m_settings.m_latitude, m_settings.m_longitude, dt, !m_settings.m_jnow);
|
|
lbTarget = true;
|
|
}
|
|
else
|
|
{
|
|
// Convert RA/Dec to Alt/Az
|
|
rd.ra = Astronomy::raToDecimal(m_settings.m_ra);
|
|
rd.dec = Astronomy::decToDecimal(m_settings.m_dec);
|
|
aa = Astronomy::raDecToAzAlt(rd, m_settings.m_latitude, m_settings.m_longitude, dt, !m_settings.m_jnow);
|
|
Astronomy::equatorialToGalactic(rd.ra, rd.dec, l, b);
|
|
}
|
|
updateRaDec(rd, dt, lbTarget);
|
|
|
|
// Adjust for refraction
|
|
if (m_settings.m_refraction == "Positional Astronomy Library")
|
|
{
|
|
aa.alt += Astronomy::refractionPAL(aa.alt, m_settings.m_pressure, m_settings.m_temperature, m_settings.m_humidity,
|
|
m_settings.m_frequency, m_settings.m_latitude, m_settings.m_heightAboveSeaLevel,
|
|
m_settings.m_temperatureLapseRate);
|
|
if (aa.alt > 90.0) {
|
|
aa.alt = 90.0f;
|
|
}
|
|
}
|
|
else if (m_settings.m_refraction == "Saemundsson")
|
|
{
|
|
aa.alt += Astronomy::refractionSaemundsson(aa.alt, m_settings.m_pressure, m_settings.m_temperature);
|
|
if (aa.alt > 90.0) {
|
|
aa.alt = 90.0f;
|
|
}
|
|
}
|
|
|
|
// Add user-adjustment
|
|
aa.alt += m_settings.m_elOffset;
|
|
aa.az += m_settings.m_azOffset;
|
|
|
|
// Send to GUI
|
|
if (getMessageQueueToGUI())
|
|
{
|
|
// MsgReportRADec sent in updateRaDec()
|
|
if (m_settings.m_target != "Custom Az/El") {
|
|
getMessageQueueToGUI()->push(StarTrackerReport::MsgReportAzAl::create(aa.az, aa.alt));
|
|
}
|
|
if (!lbTarget) {
|
|
getMessageQueueToGUI()->push(StarTrackerReport::MsgReportGalactic::create(l, b));
|
|
}
|
|
}
|
|
|
|
// Send Az/El to Rotator Controllers
|
|
// Unless we're receiving settings to display from a Radio Astronomy plugins
|
|
if (!m_settings.m_link)
|
|
{
|
|
QList<ObjectPipe*> rotatorPipes;
|
|
MainCore::instance()->getMessagePipes().getMessagePipes(m_starTracker, "target", rotatorPipes);
|
|
|
|
for (const auto& pipe : rotatorPipes)
|
|
{
|
|
MessageQueue *messageQueue = qobject_cast<MessageQueue*>(pipe->m_element);
|
|
SWGSDRangel::SWGTargetAzimuthElevation *swgTarget = new SWGSDRangel::SWGTargetAzimuthElevation();
|
|
swgTarget->setName(new QString(m_settings.m_target));
|
|
swgTarget->setAzimuth(aa.az);
|
|
swgTarget->setElevation(aa.alt);
|
|
messageQueue->push(MainCore::MsgTargetAzimuthElevation::create(m_starTracker, swgTarget));
|
|
}
|
|
}
|
|
|
|
// Send Az/El, RA/Dec and Galactic b/l to Radio Astronomy plugins
|
|
// Unless we're receiving settings to display from a Radio Astronomy plugins
|
|
if (!m_settings.m_link)
|
|
{
|
|
QList<ObjectPipe*> starTrackerPipes;
|
|
MainCore::instance()->getMessagePipes().getMessagePipes(m_starTracker, "startracker.target", starTrackerPipes);
|
|
|
|
for (const auto& pipe : starTrackerPipes)
|
|
{
|
|
MessageQueue *messageQueue = qobject_cast<MessageQueue*>(pipe->m_element);
|
|
SWGSDRangel::SWGStarTrackerTarget *swgTarget = new SWGSDRangel::SWGStarTrackerTarget();
|
|
swgTarget->setName(new QString(m_settings.m_target));
|
|
swgTarget->setAzimuth(aa.az);
|
|
swgTarget->setElevation(aa.alt);
|
|
swgTarget->setRa(rd.ra);
|
|
swgTarget->setDec(rd.dec);
|
|
swgTarget->setB(b);
|
|
swgTarget->setL(l);
|
|
swgTarget->setSolarFlux(m_solarFlux);
|
|
swgTarget->setAirTemperature(m_settings.m_temperature);
|
|
double temp;
|
|
m_starTracker->calcSkyTemperature(m_settings.m_frequency, m_settings.m_beamwidth, rd.ra, rd.dec, temp);
|
|
swgTarget->setSkyTemperature(temp);
|
|
swgTarget->setHpbw(m_settings.m_beamwidth);
|
|
// Calculate velocities
|
|
double vRot = Astronomy::earthRotationVelocity(rd, m_settings.m_latitude, m_settings.m_longitude, dt);
|
|
swgTarget->setEarthRotationVelocity(vRot);
|
|
double vOrbit = Astronomy::earthOrbitVelocityBCRS(rd,dt);
|
|
swgTarget->setEarthOrbitVelocityBcrs(vOrbit);
|
|
double vLSRK = Astronomy::sunVelocityLSRK(rd);
|
|
swgTarget->setSunVelocityLsr(vLSRK);
|
|
messageQueue->push(MainCore::MsgStarTrackerTarget::create(m_starTracker, swgTarget));
|
|
}
|
|
}
|
|
|
|
// Send to Map
|
|
if (m_settings.m_drawSunOnMap || m_settings.m_drawMoonOnMap || m_settings.m_drawStarOnMap)
|
|
{
|
|
QList<ObjectPipe*> mapMessagePipes;
|
|
MainCore::instance()->getMessagePipes().getMessagePipes(m_starTracker, "mapitems", mapMessagePipes);
|
|
|
|
if (mapMessagePipes.size() > 0)
|
|
{
|
|
// Different between GMST(Lst at Greenwich) and RA
|
|
double lst = Astronomy::localSiderealTime(dt, 0.0);
|
|
double sunLongitude;
|
|
double sunLatitude;
|
|
|
|
if (m_settings.m_drawSunOnMap || m_settings.m_drawMoonOnMap)
|
|
{
|
|
sunLongitude = Astronomy::lstAndRAToLongitude(lst, sunRD.ra);
|
|
sunLatitude = sunRD.dec;
|
|
sendToMap(mapMessagePipes, "Sun", "qrc:///startracker/startracker/sun-40.png", "Sun", sunLatitude, sunLongitude);
|
|
}
|
|
if (m_settings.m_drawMoonOnMap)
|
|
{
|
|
double moonLongitude = Astronomy::lstAndRAToLongitude(lst, moonRD.ra);
|
|
double moonLatitude = moonRD.dec;
|
|
double moonRotation;
|
|
QString phase = moonPhase(sunLongitude, moonLongitude, m_settings.m_latitude, moonRotation);
|
|
sendToMap(mapMessagePipes, "Moon", QString("qrc:///startracker/startracker/moon-%1-32").arg(phase), "Moon",
|
|
moonLatitude, moonLongitude, moonRotation);
|
|
}
|
|
if ((m_settings.m_drawStarOnMap) && (m_settings.m_target != "Sun") && (m_settings.m_target != "Moon"))
|
|
{
|
|
double starLongitude = Astronomy::lstAndRAToLongitude(lst, rd.ra);
|
|
double starLatitude = rd.dec;
|
|
QString text = m_settings.m_target.startsWith("Custom") ? "Star" : m_settings.m_target;
|
|
sendToMap(mapMessagePipes, "Star", "qrc:///startracker/startracker/pulsar-32.png", text, starLatitude, starLongitude);
|
|
}
|
|
}
|
|
}
|
|
|
|
}
|