Paparazzi UAS v7.1_unstable
Paparazzi is a free software Unmanned Aircraft System.
Loading...
Searching...
No Matches
gaia.py
Go to the documentation of this file.
1#!/usr/bin/env python3
2
3# World environment (time, wind, ...) for multi-AC simulation
4#
5# Copyright (C) 2024 Mael FEURGARD <mael.feurgard@enac.fr>
6#
7# This file is part of paparazzi.
8#
9# paparazzi is free software: you can redistribute it and/or modify
10# it under the terms of the GNU General Public License as published by
11# the Free Software Foundation, either version 3 of the License, or
12# (at your option) any later version.
13#
14# paparazzi is distributed in the hope that it will be useful,
15# but WITHOUT ANY WARRANTY; without even the implied warranty of
16# MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
17# GNU General Public License for more details.
18#
19# You should have received a copy of the GNU General Public License
20# along with paparazzi. If not, see <https://www.gnu.org/licenses/>.
21
22import argparse
23import os
24import sys
25import math
26
27PPRZ_HOME = os.getenv("PAPARAZZI_HOME", os.path.normpath(os.path.join(os.path.dirname(os.path.abspath(__file__)), '../../../')))
28sys.path.append(PPRZ_HOME + "/var/lib/python")
29
30from pprzlink.ivy import IvyMessagesInterface
31from pprzlink.message import PprzMessage
32
33
34from PyQt5 import QtCore, QtGui, QtWidgets
35from PyQt5.QtWidgets import QWidget,QMainWindow,QApplication,\
36 QLabel
37
38from gaia_python.betterHSlider import BetterHSlider
39from gaia_python.AngleSelector import AngleSelector
40
41class Ui_Dialog(object):
42 def setupUi(self, Dialog):
43 Dialog.setObjectName("Gaia")
44 Dialog.resize(663, 331)
45
46 self.horizontalLayout_3 = QtWidgets.QHBoxLayout(Dialog)
47 self.horizontalLayout_3.setObjectName("horizontalLayout_3")
48
49 self.main_horizontalLayout = QtWidgets.QHBoxLayout()
50 self.main_horizontalLayout.setObjectName("main_horizontalLayout")
51
52 self.sliders_frame = QtWidgets.QFrame(Dialog)
53 self.sliders_frame.setFrameShape(QtWidgets.QFrame.StyledPanel)
54 self.sliders_frame.setFrameShadow(QtWidgets.QFrame.Plain)
55 self.sliders_frame.setObjectName("sliders_frame")
56
57 self.verticalLayout_4 = QtWidgets.QVBoxLayout(self.sliders_frame)
58 self.verticalLayout_4.setObjectName("verticalLayout_4")
59
60 self.sliders_verticalLayout = QtWidgets.QVBoxLayout()
61 self.sliders_verticalLayout.setObjectName("sliders_verticalLayout")
62
63 self.time_slider = BetterHSlider(self.sliders_frame)
64 self.time_slider.setObjectName("time_slider")
65 self.time_slider.setText("Time scale")
66 self.time_slider.setDecimals(1)
67 self.time_slider.setRange(0.1,10)
68 self.time_slider.setValue(1)
69 self.sliders_verticalLayout.addWidget(self.time_slider)
70
71 self.hline_fst = QtWidgets.QFrame(self.sliders_frame)
72 self.hline_fst.setFrameShape(QtWidgets.QFrame.HLine)
73 self.hline_fst.setFrameShadow(QtWidgets.QFrame.Plain)
74 self.hline_fst.setObjectName("hline_fst")
75 self.sliders_verticalLayout.addWidget(self.hline_fst)
76
77 self.speed_slider = BetterHSlider(self.sliders_frame)
78 self.speed_slider.setObjectName("speed_slider")
79 self.speed_slider.setText("Wind speed (m/s)")
80 self.speed_slider.setDecimals(1)
81 self.speed_slider.setRange(0,30)
82 self.speed_slider.setValue(0)
83 self.sliders_verticalLayout.addWidget(self.speed_slider)
84
85 self.hline_snd = QtWidgets.QFrame(self.sliders_frame)
86 self.hline_snd.setFrameShape(QtWidgets.QFrame.HLine)
87 self.hline_snd.setFrameShadow(QtWidgets.QFrame.Plain)
88 self.hline_snd.setObjectName("hline_snd")
89 self.sliders_verticalLayout.addWidget(self.hline_snd)
90
91 self.up_slider = BetterHSlider(self.sliders_frame)
92 self.up_slider.setObjectName("up_slider")
93 self.up_slider.setText("Updraft (m/s)")
94 self.up_slider.setDecimals(1)
95 self.up_slider.setRange(-10,10)
96 self.up_slider.setValue(0)
97 self.sliders_verticalLayout.addWidget(self.up_slider)
98
99 self.hline_trd = QtWidgets.QFrame(self.sliders_frame)
100 self.hline_trd.setFrameShape(QtWidgets.QFrame.HLine)
101 self.hline_trd.setFrameShadow(QtWidgets.QFrame.Plain)
102 self.hline_trd.setObjectName("hline_trd")
103 self.sliders_verticalLayout.addWidget(self.hline_trd)
104
105 self.gps_checkBox = QtWidgets.QCheckBox(self.sliders_frame)
106 self.gps_checkBox.setObjectName("gps_checkBox")
107 self.gps_checkBox.setText("GPS disabled")
108 self.gps_checkBox.setChecked(False)
109 self.sliders_verticalLayout.addWidget(self.gps_checkBox, 0, QtCore.Qt.AlignHCenter)
110 self.verticalLayout_4.addLayout(self.sliders_verticalLayout)
111
112 self.main_horizontalLayout.addWidget(self.sliders_frame)
113 self.dial_frame = QtWidgets.QFrame(Dialog)
114 self.dial_frame.setFrameShape(QtWidgets.QFrame.StyledPanel)
115 self.dial_frame.setFrameShadow(QtWidgets.QFrame.Raised)
116 self.dial_frame.setObjectName("dial_frame")
117
118 self.horizontalLayout_2 = QtWidgets.QHBoxLayout(self.dial_frame)
119 self.horizontalLayout_2.setObjectName("horizontalLayout_2")
120
122 sizePolicy = QtWidgets.QSizePolicy(QtWidgets.QSizePolicy.MinimumExpanding, QtWidgets.QSizePolicy.MinimumExpanding)
123 sizePolicy.setHorizontalStretch(0)
124 sizePolicy.setVerticalStretch(0)
125 sizePolicy.setHeightForWidth(self.wind_dial.sizePolicy().hasHeightForWidth())
126 self.wind_dial.setSizePolicy(sizePolicy)
127 self.wind_dial.setLayoutDirection(QtCore.Qt.LeftToRight)
128 self.wind_dial.setObjectName("wind_dial")
129 self.wind_dial.setText("Wind direction (°)")
130 self.horizontalLayout_2.addWidget(self.wind_dial)
131 self.main_horizontalLayout.addWidget(self.dial_frame)
132 self.horizontalLayout_3.addLayout(self.main_horizontalLayout)
133
134 self.retranslateUi(Dialog)
135 QtCore.QMetaObject.connectSlotsByName(Dialog)
136
137
138
139 def retranslateUi(self, Dialog):
140 _translate = QtCore.QCoreApplication.translate
141 Dialog.setWindowTitle(_translate("Gaia", "Gaia"))
142 self.gps_checkBox.setText(_translate("Dialog", "GPS disabled"))
143
144
145
146class Gaia(QWidget,Ui_Dialog):
147 def __init__(self, parent: QWidget | None = ..., flags: QtCore.Qt.WindowFlags | QtCore.Qt.WindowType = QtCore.Qt.WindowType.Widget) -> None:
148 super().__init__(parent, flags)
149 self.setupUi(self)
150
151
152class GaiaWindow(QMainWindow):
153 def __init__(self, parent: QWidget | None = None, flags: QtCore.Qt.WindowFlags | QtCore.Qt.WindowType = QtCore.Qt.WindowType.Window) -> None:
154 super().__init__(parent, flags)
155
156 self.gaiaWidget = Gaia(self)
157
158 self.setObjectName("Gaia dialog")
159 self.setWindowTitle("Gaia dialog")
160 self.setCentralWidget(self.gaiaWidget)
161
162 self.ivy = IvyMessagesInterface("gaia")
163 self.timer = QtCore.QTimer(self)
164
165 self.timer.timeout.connect(self.__send_status)
166
167 self.gaiaWidget.gps_checkBox.stateChanged.connect(self.__send_status)
168
169 self.gaiaWidget.time_slider.valueChanged.connect(self.__send_status)
170 self.gaiaWidget.speed_slider.valueChanged.connect(self.__send_status)
171 self.gaiaWidget.up_slider.valueChanged.connect(self.__send_status)
172 self.gaiaWidget.wind_dial.valueChanged.connect(self.__send_status)
173
174 self.timer.start(5000)
175
176 def setUpdateInterval(self,msec:int):
177 self.timer.setInterval(msec)
178
179 def updateInterval(self) -> int:
180 return self.timer.interval()
181
182
183 def __send_status(self):
184 rad_wind_dir = self.gaiaWidget.wind_dial.value()*math.pi/180
185 wind_speed = self.gaiaWidget.speed_slider.value()
186 wind_up = self.gaiaWidget.up_slider.value()
187 timescale = self.gaiaWidget.time_slider.value()
188
189 msg = PprzMessage("ground","WORLD_ENV")
190 msg["wind_east"] = - wind_speed * math.sin(rad_wind_dir)
191 msg["wind_north"] = - wind_speed * math.cos(rad_wind_dir)
192 msg["wind_up"] = wind_up
193 msg["ir_contrast"] = 266
194 msg["time_scale"] = timescale
195 msg["gps_availability"] = 0 if self.gaiaWidget.gps_checkBox.isChecked() else 1
196
197 self.ivy.send(msg,self.ivy.agent_name)
198
199
200 def closeEvent(self, e: QtGui.QCloseEvent) -> None:
201 self.ivy.shutdown()
202 e.accept()
203
204if __name__ == "__main__":
205 argparse.ArgumentParser(description="World environment for the simulation of one or more aircraft: "
206 "time scale, wind speed and direction, updraft and GPS on/off, set with "
207 "sliders and sent on the Ivy bus (WORLD_ENV message) on every change "
208 "and every 5 s.").parse_known_args()
209 app = QApplication([])
210 window = GaiaWindow(flags=QtCore.Qt.WindowType.Window)
211 window.show()
212 app.exec()
213
setUpdateInterval(self, int msec)
Definition gaia.py:176
int updateInterval(self)
Definition gaia.py:179
None __init__(self, QWidget|None parent=None, QtCore.Qt.WindowFlags|QtCore.Qt.WindowType flags=QtCore.Qt.WindowType.Window)
Definition gaia.py:153
None closeEvent(self, QtGui.QCloseEvent e)
Definition gaia.py:200
None __init__(self, QWidget|None parent=..., QtCore.Qt.WindowFlags|QtCore.Qt.WindowType flags=QtCore.Qt.WindowType.Widget)
Definition gaia.py:147
setupUi(self, Dialog)
Definition gaia.py:42
sliders_verticalLayout
Definition gaia.py:60
main_horizontalLayout
Definition gaia.py:49
retranslateUi(self, Dialog)
Definition gaia.py:139
horizontalLayout_3
Definition gaia.py:46