• MikroKopter.de
• Wiki
• SHOP
• Datenschutz
• Impressum

ProjectsBL-CtrlFlightCtrlMK3MagNaviCtrl

Català-Valencià – Catalan中文 – Chinese (Simplified)中文 – Chinese (Traditional)Česky – CzechDansk – DanishNederlands – DutchEnglish – EnglishSuomi – FinnishFrançais – FrenchDeutsch – Germanעברית – Hebrewहिंदी – HindiMagyar – HungarianBahasa Indonesia – IndonesianItaliano – Italian日本語 – Japanese한국어 – KoreanМакедонски – Macedonianमराठी – MarathiNorsk – NorwegianPolski – PolishPortuguês – PortuguesePortuguês – Portuguese (Brazil)Русский – RussianSlovenčina – SlovakSlovenščina – SlovenianEspañol – SpanishSvenska – SwedishTürkçe – TurkishУкраїнська – UkrainianOëzbekcha – Uzbek

Compare Revisions

• This comparison shows the changes necessary to convert path

  → /MissionCockpit/ @ 726

  → /MissionCockpit/ @ 727

  ↔ Reverse comparison

• Compare Path:	Rev

  With Path:	Rev

Ignore whitespace Rev 726 → Rev 727

/MissionCockpit/tags/V0.4.0/Handbuch.pdf
Cannot display: file marked as a binary type.
svn:mime-type = application/octet-stream
Property changes:
Added: svn:mime-type
+application/octet-stream
\ No newline at end of property

/MissionCockpit/tags/V0.4.0/LICENSE.TXT
0,0 → 1,36
Creative Commons Lizenz mit den Zusaetzen (by, nc, sa)
======================================================
Es ist Ihnen gestattet:
* das Werk vervielfältigen, verbreiten und öffentlich zugänglich machen
* Abwandlungen bzw. Bearbeitungen des Inhaltes anfertigen
Zu den folgenden Bedingungen:
* Namensnennung.
Sie müssen den Namen des Autors/Rechteinhabers in der von ihm festgelegten Weise nennen.
* Keine kommerzielle Nutzung.
Dieses Werk darf nicht für kommerzielle Zwecke verwendet werden.
* Weitergabe unter gleichen Bedingungen.
Wenn Sie den lizenzierten Inhalt bearbeiten oder in anderer Weise umgestalten,
verändern oder als Grundlage für einen anderen Inhalt verwenden,
dürfen Sie den neu entstandenen Inhalt nur unter Verwendung von Lizenzbedingungen
weitergeben, die mit denen dieses Lizenzvertrages identisch oder vergleichbar sind.
Im Falle einer Verbreitung müssen Sie anderen die Lizenzbedingungen, unter welche dieses
Werk fällt, mitteilen. Am Einfachsten ist es, einen Link auf diese Seite einzubinden.
Jede der vorgenannten Bedingungen kann aufgehoben werden, sofern Sie die Einwilligung
des Rechteinhabers dazu erhalten.
Diese Lizenz lässt die Urheberpersönlichkeitsrechte unberührt.
Weitere Details zur Lizenzbestimmung gibt es hier:
Kurzform: http://creativecommons.org/licenses/by-nc-sa/3.0/de/
Komplett: http://creativecommons.org/licenses/by-nc-sa/3.0/de/legalcode

/MissionCockpit/tags/V0.4.0/MissionCockpit-V0.4.0.zip
Cannot display: file marked as a binary type.
svn:mime-type = application/octet-stream
Property changes:
Added: svn:mime-type
+application/octet-stream
\ No newline at end of property

/MissionCockpit/tags/V0.4.0/bin/3DMouse.exe
Cannot display: file marked as a binary type.
svn:mime-type = application/octet-stream
Property changes:
Added: svn:mime-type
+application/octet-stream
\ No newline at end of property

/MissionCockpit/tags/V0.4.0/event/mkevent.xml
0,0 → 1,75
<mkcockpit-Config CreationDate="20100210-201311"
Version="0.4.0 - 2010-02-09">
<Circle Action="&#10;if ( $MyEvent{&apos;EventCnt&apos;} == 0 )&#10; {&#10; # init at event start&#10;&#10; # set Player Pause Mode. Save old mode&#10; $ePlayerMode = $PlayerMode;&#10; &amp;PlayerPause();&#10;&#10; $eRadius = 20; # Radius/m&#10; $eTolerance = $Cfg-&gt;{&apos;waypoint&apos;}-&gt;{&apos;DefaultToleranceRadius&apos;};&#10; $eAngle = 0; # start Angle&#10; $eAngleInc = 10; # Angle increment +/-&#10;&#10; # circle center is current position&#10; $eCenter_Lat = $MkOsd{&apos;CurPos_Lat&apos;};&#10; $eCenter_Lon = $MkOsd{&apos;CurPos_Lon&apos;};&#10;&#10; &amp;TtsSpeak (&apos;MEDIUM&apos;, &quot;Fliege Kreis mit Radius $eRadius Meter&quot;);&#10;&#10; # fly to 1st target&#10; ($PlayerPause_Lat, $PlayerPause_Lon) = &amp;MapGpsAt($eCenter_Lat, $eCenter_Lon,&#10; $eRadius, $eAngle);&#10; }&#10;&#10;elsif ( $System{&apos;TargetDist&apos;} &lt; $eTolerance )&#10; {&#10; # target reached, fly to next target&#10; $eAngle += $eAngleInc;&#10; $eAngle %= 360;&#10;&#10; ($PlayerPause_Lat, $PlayerPause_Lon) = &amp;MapGpsAt($eCenter_Lat, $eCenter_Lon,&#10; $eRadius, $eAngle);&#10; }&#10;"
ActionElse="&#10;if ( $MyEvent{&apos;EventCnt&apos;} == 0 )&#10; {&#10; # set Player to original Mode&#10; &amp;PlayerModeSet($ePlayerMode);&#10; }"
Active="No"
Condition="&amp;JoystickButton(0)"
Delay="100"
Description="Kreis mit Radius 20m um die aktuelle Position.&#10;&#10;Start: Wenn Joystick Button 1 gedrückt wird.&#10;Stop: Wenn Joystick Button 1 erneut gedrückt wird.&#10;&#10;Der Event schaltet Mission Cockpit in den Player Pause Mode.&#10;Wenn der Event beendet wird, dann wird Mission Cockpit wieder in den vorher&#10;eingestellten Modus zurückgeschaltet.&#10;&#10;ACHTUNG:&#10;Vor Verwendung sollte man sich mit der Funktion des Events mit Hilfe des&#10;Simulators vertraut machen!&#10;&#10;Benutzung auf eigene Gefahr!&#10;Keine Gewähr auf Fehlerfreiheit, Vollständigkeit oder Funktion&#10;Keinerlei Haftung für direkte oder indirekte Personen- oder Sachschäden&#10;"
Repeat="500"
RepeatElse=""
Trigger="TOGGLE_RISE" />
<Elevator Action="&#10;$eSerialChannel = 11; # serieller Kanal für Gas-Steuerung (0..11)&#10;$eAltMin = 10; # Höhe unterer Umkehrpunkt in Meter&#10;$eAltMax = 30; # Höhe oberer Umkehrpunkt in Meter&#10;$eGasUp = 40; # Gas für Steigen: -125..0..125&#10;$eGasDown = -40; # Gas für Abstieg: -125..0..125&#10;&#10;if ( $MyEvent{&apos;EventCnt&apos;} == 0 )&#10; {&#10; # Erster Event-Durchlauf - Initialisierung&#10; $eMode = &quot;UP&quot;;&#10; }&#10;&#10;my $eAlt = &amp;Altitude();&#10;&#10;if ( $eMode eq &quot;UP&quot; and $eAlt &lt; $eAltMax)&#10; {&#10; # Serial Channel und damit External-Control Gas einstellen&#10; &amp;SerialChannel ($eSerialChannel, $eGasUp);&#10; }&#10;elsif ( $eMode eq &quot;DOWN&quot; and $eAlt &gt; $eAltMin)&#10; {&#10; # Serial Channel und damit External-Control Gas einstellen&#10; &amp;SerialChannel ($eSerialChannel, $eGasDown);&#10; }&#10;&#10;# Umkehrpunkte prüfen&#10;if ( $eMode eq &quot;UP&quot; and $eAlt &gt;= $eAltMax)&#10; {&#10; $eMode = &quot;DOWN&quot;;&#10; }&#10;elsif ( $eMode eq &quot;DOWN&quot; and $eAlt &lt;= $eAltMin)&#10; {&#10; $eMode = &quot;UP&quot;;&#10; }&#10;"
ActionElse="&#10;$eSerialChannel = 11; # serieller Kanal für Gas-Steuerung (0..11)&#10;&#10;if ( $MyEvent{&apos;EventCnt&apos;} == 0 )&#10; {&#10; # Gas is now controlled by RC - Set Externcontrol-Gas to max.&#10; &amp;SerialChannel ($eSerialChannel, 125);&#10; }"
Active="No"
Condition="&amp;JoystickButton(1)"
Delay="100"
Description="Bitte unbedingt lesen !!!&#10;&#10;Benutzung auf eigene Gefahr!&#10;Keine Gewähr auf Fehlerfreiheit, Vollständigkeit oder Funktion.&#10;Keinerlei Haftung für direkte oder indirekte Personen- oder Sachschäden.&#10;&#10;Funktion:&#10;Steigen auf 30m, dann Abstieg auf 10m, dann wieder Aufstieg usw. bis der&#10;Event ausgeschaltet wird.&#10;&#10;Start: Wenn Joystick Button 2 gedrückt wird.&#10;Stop: Wenn Joystick Button 2 erneut gedrückt wird.&#10;&#10;Erforderliche Einstellung im Event:&#10;- In Event &quot;Action&quot; muss der Gas-Wert für Steigen und Sinken an den&#10; jeweilgen MK angepasst werden.&#10;&#10;Erforderliche Einstellung im Mission Cockpit Einstellungs-Dialog:&#10;- &quot;Extern-Control Gas&quot; auf &quot;Serial Channel 12&quot; stellen&#10;- &quot;Extern-Control Nick&quot; und &quot;Extern-Control Roll&quot; auf &quot;0&quot; stellen.&#10;- &quot;Extern-Control &quot; auf &quot;0&quot; stellen.&#10;- &quot;Extern-Control Senden&quot; aktivieren (Beachte Hinweise weiter unten)&#10;&#10;Falls man &quot;External-Control Nick/Roll/Gier&quot; über Joystick/Maus steuern will,&#10;dann kann man das natürlich einstellen.&#10;&#10;Erforderliche Einstellung im Kopter-Tool:&#10;- Es muss der Vario-Höhenregler aktiv sein.&#10;- &quot;Stick Neutral Punkt&quot; muss 120 sein (Mittelposition)&#10;- &quot;Externe Kontrolle&quot; muss auf einen Wert größer als 128 eingestellt sein.&#10;&#10;WICHTIG:&#10;Beachte folgende Hinweise zum Umgang mit Gas bei aktiviertem External-Control:&#10;&#10;ACHTUNG:&#10;Wenn External Control aktiv ist, dann bestimmt der Gas-Stick am Sender&#10;das maximal mögliche Gas. Der Gas-Stick muss also entsprechend hoch eingestellt&#10;sein, damit Mission Cockpit auch Gas geben kann.&#10;&#10;Im Umkehrschluss kann mit dem RC Gas-Stick nicht mehr Gas gegeben werden,&#10;als von Mission Cockpit über External-Control vorgegeben.&#10;&#10;ACHTUNG:&#10;Wenn der Event beim Starten vom Mission Cockpit deaktiviert ist und der&#10;serielle Kanal 12 nicht anderweitig belegt ist, dann wird &quot;External-Control Gas&quot;&#10;auf Halb-Gas eingestellt. Mit dem RC-Stick kann dann auch nicht mehr Gas als&#10;Halb-Gas gegeben werden.&#10;&#10;ACHTUNG:&#10;Wenn der Event beim Starten vom Mission Cockpit aktiviert und ausgeschaltet ist,&#10;dann wird &quot;External-Control Gas&quot; auf Vollgas eingestellt.&#10;Das maximal möglich Gas wird dann vom RC-Stick vorgegeben.&#10;Gas wird also über den RC-Stick gesteuert.&#10;&#10;ACHTUNG:&#10;Wenn der Event ausgeschaltet wird, dann wird für &quot;External-Control Gas&quot;&#10;Vollgas eingestellt. Dann muss das Gas am RC-Stick wieder REDUZIERT werden.&#10;Das Gas wird dann wieder über den RC-Stick geteuert.&#10;&#10;ACHTUNG:&#10;Vor Verwendung sollte man sich mit der Funktion des Events mit Hilfe des&#10;Simulators und der Debug-Anzeige &quot;Externe Steuerung&quot; vertraut machen!&#10;"
Repeat="100"
RepeatElse="100"
Trigger="TOGGLE_RISE" />
<Entfernung Action="if ( &amp;CurPosIsValid() and &amp;HomePosIsValid() )&#10; {&#10; my ($Dist, $Bearing) = &amp;MapGpsTo($MkOsd{&apos;CurPos_Lat&apos;}, $MkOsd{&apos;CurPos_Lon&apos;},&#10; $MkOsd{&apos;HomePos_Lat&apos;}, $MkOsd{&apos;HomePos_Lon&apos;} );&#10;&#10; &amp;TtsSpeak(&apos;HIGH&apos;, sprintf &quot;Entfernung. %d. Meter&quot;, int ($Dist + 0.5) );&#10; }"
ActionElse=""
Active="No"
Condition="1"
Delay=""
Description="Ansage: Entfernung zur Home-Position"
Repeat="15000"
RepeatElse=""
Trigger="TRUE" />
<GierPOI Action="my $eGierChannel = 10; # Serial Channel 0..11 for Gier Control&#10;&#10;if ( $MyEvent{&apos;EventCnt&apos;} == 0 )&#10; {&#10; # PID Parameter müssen an den jeweiligen MK angepasst werden.&#10; $eGierKp = 0.6; # P&#10; $eGierKi = 0.5; # I&#10; $eGierKd = 0.1; # D&#10;&#10; $eGierLimitY = 50; # Begrenzung Gier-Stick -125..0..125&#10; $eGierLimitI = 500; # Limit I-Anteil&#10; $eGierTa = $MyEvent{&apos;Repeat&apos;}/1000; # Abtastzeit in s&#10;&#10; $eGierEsum = 0;&#10; $eGierEalt = 0;&#10;&#10; # Gier auf Mittelstellung&#10; &amp;SerialChannel ($eGierChannel, 0);&#10; }&#10;&#10;if ( &amp;CurPosIsValid() )&#10; {&#10; # Entfernung und Soll Winkel zum POI&#10; my ($Dist, $w) = &amp;MapGpsTo($MkOsd{&apos;CurPos_Lat&apos;}, $MkOsd{&apos;CurPos_Lon&apos;},&#10; $Poi_Lat, $Poi_Lon );&#10; # Ist Kompass Winkel MK&#10; my $x = $MkOsd{&apos;CompassHeading&apos;};&#10;&#10; my $e = $w - $x; # Vergleich&#10; if ($e &gt; 180 )&#10; {&#10; $e -= 360;&#10; }&#10; elsif ($e &lt; -180 )&#10; {&#10; $e += 360;&#10; }&#10;&#10; $eGierEsum += $e; # Integration I-Anteil&#10; if ( $eGierEsum &gt; $eGierLimitI ) { $eGierEsum = $eGierLimitI; }&#10; if ( $eGierEsum &lt; - $eGierLimitI ) { $eGierEsum = - $eGierLimitI; }&#10;&#10; my $y = $eGierKp * $e + # Reglergleichung&#10; $eGierKi * $eGierTa * $eGierEsum +&#10; $eGierKd / $eGierTa * ($e - $eGierEalt);&#10; $eGierEalt = $e;&#10;&#10;# printf &quot;W: %3.2f, X: %3.0f, E: %3.2f, S: %3.2f, A: %3.2f\n&quot;,&#10;# $w, $x, $e, $eGierEsum, $eGierEalt;&#10;&#10; # Limit Gier symmetrical&#10; if ( $y &gt; $eGierLimitY ) { $y = $eGierLimitY; }&#10; if ( $y &lt; - $eGierLimitY ) { $y = - $eGierLimitY; }&#10; $y = int ($y + 0.5);&#10; &#10; if ( $Dist &lt; 5 )&#10; {&#10; # too close to POI, keine Gier steuerung&#10; $y = 0;&#10; }&#10;&#10; # set Gier stick&#10; &amp;SerialChannel ($eGierChannel, $y);&#10; }&#10;&#10;# Beschreibung PID Regler:&#10;# http://www.rn-wissen.de/index.php/Regelungstechnik&#10;"
ActionElse="my $eGierChannel = 10; # Serial Channel 0..11 for Gier Control&#10;&#10;&amp;SerialChannel ($eGierChannel, 0);&#10;"
Active="No"
Condition="$PoiMode"
Delay=""
Description="Bitte unbedingt lesen !!!&#10;&#10;Benutzung auf eigene Gefahr!&#10;Keine Gewähr auf Fehlerfreiheit, Vollständigkeit oder Funktion.&#10;Keinerlei Haftung für direkte oder indirekte Personen- oder Sachschäden.&#10;&#10;WARNUNG:&#10;Der Event greift per External-Control direkt in die Flugsteuerung ein.&#10;Unbedingt die Hinweise im Handbuch beachten!&#10;&#10;Funktion:&#10;Richtet denn MK mit Blick zum POI aus.&#10;Gier-Steuerung erfolgt nur, wenn die Entfernung des MK zum POI &gt; 5m ist.&#10;Bei geringerer Entfernung ist die Berechnung des Soll-Kompass-Winkels zum POI&#10;zu ungenau.&#10;&#10;Start: Wenn POI-Mode aktiviert wird (Taste &quot;v&quot; drücken)&#10;Stop: Weenn POI-Mode deaktiviert wird (Taste &quot;v&quot; erneut drücken)&#10;&#10;Erforderliche Einstellung im Event-&gt;Action:&#10;- Die PID Parameter müssen an den jeweiligen MikroKopter angepasst werden.&#10;- Die Nummer des seriellen Kanals, der auf External-Control-&gt;Gier gemappt&#10; wird, muss in Event-Action UND Event-&gt;Action/Else angepasst werden&#10;&#10;Erforderliche Einstellung im Mission Cockpit Einstellungs-Dialog:&#10;- &quot;Extern-Control Gas&quot; auf 255 stellen&#10;- &quot;Extern-Control Nick&quot; und &quot;Extern-Control Roll&quot; auf &quot;0&quot; stellen.&#10;- &quot;Extern-Control Gier&quot; &quot;Serial Channel 11&quot; stellen&#10;- &quot;Extern-Control Senden&quot; aktivieren&#10;&#10;Falls man &quot;External-Control Nick/Roll/Gas&quot; über Joystick/Maus steuern will,&#10;dann kann man das natürlich einstellen.&#10;&#10;Erforderliche Einstellung im Kopter-Tool:&#10;- &quot;Externe Kontrolle&quot; muss auf einen Wert größer als 128 eingestellt sein.&#10;&#10;"
Repeat="100"
RepeatElse="100"
Trigger="TRUE" />
<Haus Action="my $eSize = 30; # Haus Kantenlänge in Meter&#10;&#10;# 44 Möglichkeiten das Haus vom Nikolaus zu zeichnen&#10;my @eVariante = ( &#10;&quot;123143542&quot;, &quot;123145342&quot;, &quot;123413542&quot;, &quot;123453142&quot;, &quot;123541342&quot;,&#10;&quot;123543142&quot;, &quot;124134532&quot;, &quot;124135432&quot;, &quot;124314532&quot;, &quot;124354132&quot;,&#10;&quot;124531432&quot;, &quot;124534132&quot;, &quot;132143542&quot;, &quot;132145342&quot;, &quot;132435412&quot;,&#10;&quot;132453412&quot;, &quot;134123542&quot;, &quot;134124532&quot;, &quot;134214532&quot;, &quot;134235412&quot;,&#10;&quot;134532142&quot;, &quot;134532412&quot;, &quot;135412342&quot;, &quot;135412432&quot;, &quot;135421432&quot;,&#10;&quot;135423412&quot;, &quot;135432142&quot;, &quot;135432412&quot;, &quot;142134532&quot;, &quot;142135432&quot;,&#10;&quot;142345312&quot;, &quot;142354312&quot;, &quot;143123542&quot;, &quot;143124532&quot;, &quot;143213542&quot;,&#10;&quot;143245312&quot;, &quot;143542132&quot;, &quot;143542312&quot;, &quot;145312342&quot;, &quot;145312432&quot;,&#10;&quot;145321342&quot;, &quot;145324312&quot;, &quot;145342132&quot;, &quot;145342312&quot;, );&#10;&#10;my @eHaus = ( # 0/0 ist linke, untere Hausecke = Haus-Referenzpunkt&#10; 0.0, 0.0,&#10; 1.0, 0.0,&#10; 1.0, 1.0,&#10; 0.0, 1.0,&#10; 0.5, 1.5, );&#10;&#10;# Eine der 44 Varianten per Zufallsgenerator ermitteln&#10;$eIndex = int rand (44); # 0..43&#10;$eSequence = $eVariante[$eIndex];&#10;&#10;&amp;TtsSpeak (&apos;MEDIUM&apos;, &quot;Haus vom Nikolaus. Variante $eIndex&quot;);&#10;print &quot;$MyEvent{&apos;EventName&apos;} - Haus vom Nikolaus - Variante: $eIndex Sequenz: $eSequence\n&quot;;&#10;&#10;# Delete all Waypoints&#10;&amp;WpDeleteAll();&#10;&#10;# Haus links/unten ist aktuelle MK-Position&#10;$eHouseCenter_Lat = $MkOsd{&apos;CurPos_Lat&apos;};&#10;$eHouseCenter_Lon = $MkOsd{&apos;CurPos_Lon&apos;};&#10;$eHouseDirection = $MkOsd{&apos;CompassHeading&apos;};&#10;&#10;# für jeden Sequenz-Punkt einen WP berechnen und setzen&#10;for ( $i=0; $i&lt; length $eSequence; $i++ )&#10; {&#10; # Nummer der Haus-Ecke&#10; my $ePoint = substr ($eSequence, $i, 1) - 1;&#10;&#10; # Zielpunkt: Relativer Abstand zum Haus-Referenzpunkt&#10; my $ePointX = $eSize * $eHaus[$ePoint * 2];&#10; my $ePointY = $eSize * $eHaus[$ePoint * 2 + 1];&#10;&#10; # Polarkoordinaten: Entfernung, Winkel zum Haus-Referenzpunkt&#10; my $eDist = sqrt ($ePointX * $ePointX + $ePointY * $ePointY);&#10; my $eAngle = $eHouseDirection + rad2deg atan2 ($ePointX, $ePointY);&#10;&#10; # Ziel - GPS Koordinaten berechnen&#10; my ($eWp_Lat, $eWp_Lon) = &amp;MapGpsAt($eHouseCenter_Lat, $eHouseCenter_Lon,&#10; $eDist, $eAngle);&#10; # Wp hinzufügen&#10; &amp;WpAdd (-lat =&gt; $eWp_Lat,&#10; -lon =&gt; $eWp_Lon,&#10; );&#10; }&#10;&#10;# Neue Wp Icons auf der Karte anzeigen&#10;&amp;WpRedrawIcons();&#10;&amp;WpRedrawLines();&#10;&#10;# Player in STD Mode schalten&#10;&amp;PlayerPlay();&#10;&amp;PlayerRandomStd();&#10;"
ActionElse=""
Active="No"
Condition="&amp;JoystickButton(2)"
Delay="100"
Description="Bitte unbedingt lesen !!!&#10;&#10;Benutzung auf eigene Gefahr!&#10;Keine Gewähr auf Fehlerfreiheit, Vollständigkeit oder Funktion&#10;Keinerlei Haftung für direkte oder indirekte Personen- oder Sachschäden&#10;&#10;Funktion:&#10;- Löscht die aktuellen Wegpunkte&#10;- Ermittelt durch Zufallsgenerator eine der 44 Möglichkeiten das&#10;&quot;Haus vom Nikolaus&quot; zu zeichnen (http://de.wikipedia.org/wiki/Haus_vom_Nikolaus)&#10;- Setzt Wegpunkte für die ausgewählte Variante&#10;- Schalet den Player in den Player Play und Random-STD Modus&#10;- Das Haus wird in die Richtung gebaut, in die der MK gerade zeigt.&#10;- Startpunkt ist die linke, untere Hausecke.&#10;- Die Länge einer Hauskante ist 30m. Kann in &quot;Action&quot; eingestellt werden.&#10;&#10;Start: Wenn Joystick Button 3 gedrückt wird.&#10;&#10;ACHTUNG:&#10;Vor Verwendung sollte man sich mit der Funktion des Events mit Hilfe des&#10;Simulators vertraut machen!&#10;"
Repeat="100"
RepeatElse=""
Trigger="RISE" />
<Höhe Action="&amp;TtsSpeak(&apos;HIGH&apos;, &quot;flieg nicht zu hoch&quot;)"
ActionElse=""
Active="No"
Condition="&amp;Altitude() &gt; 50"
Delay="5000"
Description="Ansage: Flieg nicht so hoch, wenn &gt; 50m"
Repeat=""
RepeatElse=""
Trigger="RISE" />
<Test1 Action="print &quot;Action &quot; . time . &quot;\n&quot;;"
ActionElse="print &quot;ActionElse &quot; . time . &quot;\n&quot;;"
Active="No"
Condition="&amp;JoystickButton(0)"
Delay=""
Description="Test"
Repeat="1000"
RepeatElse="2000"
Trigger="TRUE" />
<Test2 Action="&amp;DisplayHash(\%MyEvent, &quot;MyEvent&quot;, &quot;Display&quot;)"
ActionElse=""
Active="No"
Condition="&amp;JoystickButton(0)"
Delay="10000"
Description="Test: Variable %MyEvent anzeigen"
Repeat=""
RepeatElse=""
Trigger="RISE" />
</mkcockpit-Config>

/MissionCockpit/tags/V0.4.0/geserver.pl
0,0 → 1,209
#!/usr/bin/perl
#!/usr/bin/perl -d:ptkdb
###############################################################################
#
# geserver.pl - Google Earth Server for MK Mission Cockpit
#
# Copyright (C) 2009 Rainer Walther (rainerwalther-mail@web.de)
#
# Creative Commons Lizenz mit den Zusaetzen (by, nc, sa)
#
# Es ist Ihnen gestattet:
# * das Werk vervielfältigen, verbreiten und öffentlich zugänglich machen
# * Abwandlungen bzw. Bearbeitungen des Inhaltes anfertigen
#
# Zu den folgenden Bedingungen:
# * Namensnennung.
# Sie müssen den Namen des Autors/Rechteinhabers in der von ihm festgelegten Weise nennen.
# * Keine kommerzielle Nutzung.
# Dieses Werk darf nicht für kommerzielle Zwecke verwendet werden.
# * Weitergabe unter gleichen Bedingungen.
# Wenn Sie den lizenzierten Inhalt bearbeiten oder in anderer Weise umgestalten,
# verändern oder als Grundlage für einen anderen Inhalt verwenden,
# dürfen Sie den neu entstandenen Inhalt nur unter Verwendung von Lizenzbedingungen
# weitergeben, die mit denen dieses Lizenzvertrages identisch oder vergleichbar sind.
#
# Im Falle einer Verbreitung müssen Sie anderen die Lizenzbedingungen, unter welche dieses
# Werk fällt, mitteilen. Am Einfachsten ist es, einen Link auf diese Seite einzubinden.
#
# Jede der vorgenannten Bedingungen kann aufgehoben werden, sofern Sie die Einwilligung
# des Rechteinhabers dazu erhalten.
#
# Diese Lizenz lässt die Urheberpersönlichkeitsrechte unberührt.
#
# Weitere Details zur Lizenzbestimmung gibt es hier:
# Kurzform: http://creativecommons.org/licenses/by-nc-sa/3.0/de/
# Komplett: http://creativecommons.org/licenses/by-nc-sa/3.0/de/legalcode
#
###############################################################################
#
# 20090317 0.0.1 rw created
# 20090401 0.1.0 rw RC1
# 20091215 0.1.1 rw Move cfg to "logging"-section
#
###############################################################################
$Version{'geserver.pl'} = "0.1.1 - 2009-12-15";
#
# Parameter
#
$port_listen = $Cfg->{'logging'}->{'HttpPort'} || 8080;
use Socket;
use IO::Select;
use threads;
use threads::shared;
$| = 1;
# "Lon, Lat, Alt"
share (@GeCoords);
sub GeServer()
{
local *S;
socket (S, PF_INET , SOCK_STREAM , getprotobyname('tcp')) or die "couldn't open socket: $!";
setsockopt (S, SOL_SOCKET, SO_REUSEADDR, 1);
bind (S, sockaddr_in($port_listen, INADDR_ANY));
listen (S, 5) or die "don't hear anything: $!";
my $ss = IO::Select->new();
$ss -> add (*S);
while(1)
{
my @connections_pending = $ss->can_read();
foreach (@connections_pending)
{
my $fh;
my $remote = accept($fh, $_);
my($port,$iaddr) = sockaddr_in($remote);
my $peeraddress = inet_ntoa($iaddr);
# memory-leak in threads!!! Process only one request in parallel
# my $t = threads->create(\&new_connection, $fh);
&new_connection ($fh);
}
}
}
sub new_connection
{
my $fh = shift;
binmode $fh;
my %req;
$req{HEADER}={};
my $request_line = <$fh>;
my $first_line = "";
while ($request_line ne "\r\n")
{
unless ($request_line)
{
close $fh;
}
chomp $request_line;
unless ($first_line)
{
$first_line = $request_line;
my @parts = split(" ", $first_line);
if (@parts != 3)
{
close $fh;
}
$req{METHOD} = $parts[0];
$req{OBJECT} = $parts[1];
}
else
{
my ($name, $value) = split(": ", $request_line);
$name = lc $name;
$req{HEADER}{$name} = $value;
}
$request_line = <$fh>;
}
&http_request_handler($fh, \%req);
close $fh;
}
sub http_request_handler
{
my $fh = shift;
my $req_ = shift;
my %req = %$req_;
my %header = %{$req{HEADER}};
print $fh "HTTP/1.0 200 OK\n";
print $fh "Content-Type: application/vnd.google-earth.kml+xml; charset=iso-8859-1\n";
print $fh "Connection: close\n\n";
# KML Header
print $fh <<EOF;
<?xml version="1.0" encoding="UTF-8"?>
<kml xmlns="http://earth.google.com/kml/2.2">
<Document>
<name>Mikrokopter GPS logging</name>
<Style id="MK_gps-style">
<LineStyle>
<color>ff0000ff</color>
<width>2</width>
</LineStyle>
</Style>
<Placemark>
<name>Flight live</name>
<styleUrl>MK_gps-style</styleUrl>
<LineString>
<tessellate>1</tessellate>
<altitudeMode>relativeToGround</altitudeMode>
<coordinates>
EOF
# send all KML Coords for each request
for $i (0 .. $#GeCoords)
{
print $fh "$GeCoords[$i]\n";
}
# KML Trailler
print $fh <<EOF;
</coordinates>
</LineString>
</Placemark>
</Document>
</kml>
EOF
# Debug:
# print "Method: $req{METHOD}\n";
# print "Object: $req{OBJECT}\n>";
# foreach my $r (keys %header)
# {
# print $r, " = ", $header{$r} , "\n";
# }
}
1;
__END__

/MissionCockpit/tags/V0.4.0/icon/Antenna_48.gif
Cannot display: file marked as a binary type.
svn:mime-type = application/octet-stream
Property changes:
Added: svn:mime-type
+application/octet-stream
\ No newline at end of property

/MissionCockpit/tags/V0.4.0/icon/ModeKml_48.gif
Cannot display: file marked as a binary type.
svn:mime-type = application/octet-stream
Property changes:
Added: svn:mime-type
+application/octet-stream
\ No newline at end of property

/MissionCockpit/tags/V0.4.0/icon/ModeWpt_48.gif
Cannot display: file marked as a binary type.
svn:mime-type = application/octet-stream
Property changes:
Added: svn:mime-type
+application/octet-stream
\ No newline at end of property

/MissionCockpit/tags/V0.4.0/icon/RandomMap_48.gif
Cannot display: file marked as a binary type.
svn:mime-type = application/octet-stream
Property changes:
Added: svn:mime-type
+application/octet-stream
\ No newline at end of property

/MissionCockpit/tags/V0.4.0/icon/RandomOff_48.gif
Cannot display: file marked as a binary type.
svn:mime-type = application/octet-stream
Property changes:
Added: svn:mime-type
+application/octet-stream
\ No newline at end of property

/MissionCockpit/tags/V0.4.0/icon/RandomOn_48.gif
Cannot display: file marked as a binary type.
svn:mime-type = application/octet-stream
Property changes:
Added: svn:mime-type
+application/octet-stream
\ No newline at end of property

/MissionCockpit/tags/V0.4.0/icon/RandomWpt_48.gif
Cannot display: file marked as a binary type.
svn:mime-type = application/octet-stream
Property changes:
Added: svn:mime-type
+application/octet-stream
\ No newline at end of property

/MissionCockpit/tags/V0.4.0/icon/Record_48.gif
Cannot display: file marked as a binary type.
svn:mime-type = application/octet-stream
Property changes:
Added: svn:mime-type
+application/octet-stream
\ No newline at end of property

/MissionCockpit/tags/V0.4.0/icon/WpFirst.gif
Cannot display: file marked as a binary type.
svn:mime-type = application/octet-stream
Property changes:
Added: svn:mime-type
+application/octet-stream
\ No newline at end of property

/MissionCockpit/tags/V0.4.0/icon/WpHome.gif
Cannot display: file marked as a binary type.
svn:mime-type = application/octet-stream
Property changes:
Added: svn:mime-type
+application/octet-stream
\ No newline at end of property

/MissionCockpit/tags/V0.4.0/icon/WpLast.gif
Cannot display: file marked as a binary type.
svn:mime-type = application/octet-stream
Property changes:
Added: svn:mime-type
+application/octet-stream
\ No newline at end of property

/MissionCockpit/tags/V0.4.0/icon/WpNext.gif
Cannot display: file marked as a binary type.
svn:mime-type = application/octet-stream
Property changes:
Added: svn:mime-type
+application/octet-stream
\ No newline at end of property

/MissionCockpit/tags/V0.4.0/icon/WpPause.gif
Cannot display: file marked as a binary type.
svn:mime-type = application/octet-stream
Property changes:
Added: svn:mime-type
+application/octet-stream
\ No newline at end of property

/MissionCockpit/tags/V0.4.0/icon/WpPlay.gif
Cannot display: file marked as a binary type.
svn:mime-type = application/octet-stream
Property changes:
Added: svn:mime-type
+application/octet-stream
\ No newline at end of property

/MissionCockpit/tags/V0.4.0/icon/WpPrev.gif
Cannot display: file marked as a binary type.
svn:mime-type = application/octet-stream
Property changes:
Added: svn:mime-type
+application/octet-stream
\ No newline at end of property

/MissionCockpit/tags/V0.4.0/icon/WpStop.gif
Cannot display: file marked as a binary type.
svn:mime-type = application/octet-stream
Property changes:
Added: svn:mime-type
+application/octet-stream
\ No newline at end of property

/MissionCockpit/tags/V0.4.0/icon/bear_48.gif
Cannot display: file marked as a binary type.
svn:mime-type = application/octet-stream
Property changes:
Added: svn:mime-type
+application/octet-stream
\ No newline at end of property

/MissionCockpit/tags/V0.4.0/icon/heart_32.gif
Cannot display: file marked as a binary type.
svn:mime-type = application/octet-stream
Property changes:
Added: svn:mime-type
+application/octet-stream
\ No newline at end of property

/MissionCockpit/tags/V0.4.0/icon/heart_48.gif
Cannot display: file marked as a binary type.
svn:mime-type = application/octet-stream
Property changes:
Added: svn:mime-type
+application/octet-stream
\ No newline at end of property

/MissionCockpit/tags/V0.4.0/icon/satellite_64.gif
Cannot display: file marked as a binary type.
svn:mime-type = application/octet-stream
Property changes:
Added: svn:mime-type
+application/octet-stream
\ No newline at end of property

/MissionCockpit/tags/V0.4.0/icon/target_48.gif
Cannot display: file marked as a binary type.
svn:mime-type = application/octet-stream
Property changes:
Added: svn:mime-type
+application/octet-stream
\ No newline at end of property

/MissionCockpit/tags/V0.4.0/icon/waypoint_24x48.gif
Cannot display: file marked as a binary type.
svn:mime-type = application/octet-stream
Property changes:
Added: svn:mime-type
+application/octet-stream
\ No newline at end of property

/MissionCockpit/tags/V0.4.0/icon/waypoint_48.gif
Cannot display: file marked as a binary type.
svn:mime-type = application/octet-stream
Property changes:
Added: svn:mime-type
+application/octet-stream
\ No newline at end of property

/MissionCockpit/tags/V0.4.0/icon/webcam_48.gif
Cannot display: file marked as a binary type.
svn:mime-type = application/octet-stream
Property changes:
Added: svn:mime-type
+application/octet-stream
\ No newline at end of property

/MissionCockpit/tags/V0.4.0/libcfgopt.pl
0,0 → 1,298
#!/usr/bin/perl
#!/usr/bin/perl -d:ptkdb
###############################################################################
#
# libcfgopt.pl - Option menus
#
# Copyright (C) 2009 Rainer Walther (rainerwalther-mail@web.de)
#
# Creative Commons Lizenz mit den Zusaetzen (by, nc, sa)
#
# Es ist Ihnen gestattet:
# * das Werk vervielfältigen, verbreiten und öffentlich zugänglich machen
# * Abwandlungen bzw. Bearbeitungen des Inhaltes anfertigen
#
# Zu den folgenden Bedingungen:
# * Namensnennung.
# Sie müssen den Namen des Autors/Rechteinhabers in der von ihm festgelegten Weise nennen.
# * Keine kommerzielle Nutzung.
# Dieses Werk darf nicht für kommerzielle Zwecke verwendet werden.
# * Weitergabe unter gleichen Bedingungen.
# Wenn Sie den lizenzierten Inhalt bearbeiten oder in anderer Weise umgestalten,
# verändern oder als Grundlage für einen anderen Inhalt verwenden,
# dürfen Sie den neu entstandenen Inhalt nur unter Verwendung von Lizenzbedingungen
# weitergeben, die mit denen dieses Lizenzvertrages identisch oder vergleichbar sind.
#
# Im Falle einer Verbreitung müssen Sie anderen die Lizenzbedingungen, unter welche dieses
# Werk fällt, mitteilen. Am Einfachsten ist es, einen Link auf diese Seite einzubinden.
#
# Jede der vorgenannten Bedingungen kann aufgehoben werden, sofern Sie die Einwilligung
# des Rechteinhabers dazu erhalten.
#
# Diese Lizenz lässt die Urheberpersönlichkeitsrechte unberührt.
#
# Weitere Details zur Lizenzbestimmung gibt es hier:
# Kurzform: http://creativecommons.org/licenses/by-nc-sa/3.0/de/
# Komplett: http://creativecommons.org/licenses/by-nc-sa/3.0/de/legalcode
#
###############################################################################
#
# 2009-10-28 0.0.1 rw created
# 2010-02-10 0.4.0 rw Stick control
# event configuration
#
###############################################################################
$Version{'libcfgopt.pl'} = "0.4.0 - 2010-02-10";
# File selection dialog
%CfgFile = ( WpFile => "Filename", # Filename, Path
KmlFile => "Filename",
EventFile => "Filename",
Program => "Path",
);
# Multiline Text dialog
%CfgText = ( Condition => "80;24", # width;height
Action => "80;24",
ActionElse => "80;24",
Description => "80;24",
);
# Option Menue
%CfgOpt = (
AudioMute => [ "Yes", "No", ],
PlayerMode => [ "Play", "Pause", "Home", "Stop", ],
PlayerRandomMode => [ "STD", "RND", "MAP", ],
PlayerWptKmlMode => [ "WPT", "KML",],
PlayerPauseMode => [ "MAP", "MK",],
Active => [ "Yes", "No", ],
Port => [ "COM1", "COM2", "COM3", "COM4", "COM5", "COM6", "COM7", "COM8",
"COM9", "COM10", "COM11", "COM12", "COM13", "COM14", "COM15", "COM16", ],
PortSetSkip => [ "Yes", "No", ],
MapDefault => [ sort keys %Maps ],
TxExtOn => [ "Yes", "No", ],
Message1 => [ "", "FLIGHT_TIME", "BATTERY", "ALTITUDE", "SATELLITES", "HOME_DIST", "TARGET_DIST", ],
Message2 => [ "", "FLIGHT_TIME", "BATTERY", "ALTITUDE", "SATELLITES", "HOME_DIST", "TARGET_DIST", ],
Message3 => [ "", "FLIGHT_TIME", "BATTERY", "ALTITUDE", "SATELLITES", "HOME_DIST", "TARGET_DIST", ],
Message4 => [ "", "FLIGHT_TIME", "BATTERY", "ALTITUDE", "SATELLITES", "HOME_DIST", "TARGET_DIST", ],
Message5 => [ "", "FLIGHT_TIME", "BATTERY", "ALTITUDE", "SATELLITES", "HOME_DIST", "TARGET_DIST", ],
Message6 => [ "", "FLIGHT_TIME", "BATTERY", "ALTITUDE", "SATELLITES", "HOME_DIST", "TARGET_DIST", ],
Message7 => [ "", "FLIGHT_TIME", "BATTERY", "ALTITUDE", "SATELLITES", "HOME_DIST", "TARGET_DIST", ],
Message8 => [ "", "FLIGHT_TIME", "BATTERY", "ALTITUDE", "SATELLITES", "HOME_DIST", "TARGET_DIST", ],
Message9 => [ "", "FLIGHT_TIME", "BATTERY", "ALTITUDE", "SATELLITES", "HOME_DIST", "TARGET_DIST", ],
Trigger => [ RISE, FALL, TOGGLE_RISE, TOGGLE_FALL, TRUE, FALSE, ],
SerialChannelSend => [ "Yes", "No" ],
ExternControlSend => [ "Yes", "No" ],
ExternControlNickExpo => [ "100", "90", "80", "70", "60", "50", "40", "30", "20", "10", "0",
"-10", "-20", "-30", "-40", "-50", "-60", "-70", "-80", "-90", "-100", ],
ExternControlRollExpo => [ "100", "90", "80", "70", "60", "50", "40", "30", "20", "10", "0",
"-10", "-20", "-30", "-40", "-50", "-60", "-70", "-80", "-90", "-100", ],
ExternControlGasExpo => [ "100", "90", "80", "70", "60", "50", "40", "30", "20", "10", "0",
"-10", "-20", "-30", "-40", "-50", "-60", "-70", "-80", "-90", "-100", ],
ExternControlGierExpo => [ "100", "90", "80", "70", "60", "50", "40", "30", "20", "10", "0",
"-10", "-20", "-30", "-40", "-50", "-60", "-70", "-80", "-90", "-100", ],
CrosshairMoveXExpo => [ "100", "90", "80", "70", "60", "50", "40", "30", "20", "10", "0",
"-10", "-20", "-30", "-40", "-50", "-60", "-70", "-80", "-90", "-100", ],
CrosshairMoveYExpo => [ "100", "90", "80", "70", "60", "50", "40", "30", "20", "10", "0",
"-10", "-20", "-30", "-40", "-50", "-60", "-70", "-80", "-90", "-100", ],
ExternControlNickLimit => [ "0", "10", "20", "30", "40", "50", "60", "70", "80", "90", "100",
"110", "120", "130", "140", "150", "160", "170", "180", "190", "200", ],
ExternControlRollLimit => [ "0", "10", "20", "30", "40", "50", "60", "70", "80", "90", "100",
"110", "120", "130", "140", "150", "160", "170", "180", "190", "200", ],
ExternControlGasLimit => [ "0", "10", "20", "30", "40", "50", "60", "70", "80", "90", "100",
"110", "120", "130", "140", "150", "160", "170", "180", "190", "200", ],
ExternControlGierLimit => [ "0", "10", "20", "30", "40", "50", "60", "70", "80", "90", "100",
"110", "120", "130", "140", "150", "160", "170", "180", "190", "200", ],
CrosshairMoveXLimit => [ "0", "10", "20", "30", "40", "50", "60", "70", "80", "90", "100",
"110", "120", "130", "140", "150", "160", "170", "180", "190", "200", ],
CrosshairMoveYLimit => [ "0", "10", "20", "30", "40", "50", "60", "70", "80", "90", "100",
"110", "120", "130", "140", "150", "160", "170", "180", "190", "200", ],
CrosshairMoveX => [ "",
"JoystickX", "JoystickY", "JoystickZ", "JoystickR", "JoystickU", "JoystickV",
"MouseRotX", "MouseRotY", "MouseRotZ",
"MouseTranX", "MouseTranY", "MouseTranZ", ],
CrosshairMoveY => [ "",
"JoystickX", "JoystickY", "JoystickZ", "JoystickR", "JoystickU", "JoystickV",
"MouseRotX", "MouseRotY", "MouseRotZ",
"MouseTranX", "MouseTranY", "MouseTranZ", ],
ExternControlNick => [ "",
"JoystickX", "JoystickX_Reverse", "JoystickY", "JoystickY_Reverse", "JoystickZ", "JoystickZ_Reverse",
"JoystickR", "JoystickR_Reverse", "JoystickU", "JoystickU_Reverse", "JoystickV", "JoystickV_Reverse",
"MouseRotX", "MouseRotX_Reverse", "MouseRotY", "MouseRotY_Reverse", "MouseRotZ", "MouseRotZ_Reverse",
"MouseTranX", "MouseTranX_Reverse", "MouseTranY", "MouseTranY_Reverse", "MouseTranZ", "MouseTranZ_Reverse",
"SerialChannel01", "SerialChannel02", "SerialChannel03", "SerialChannel04", "SerialChannel05", "SerialChannel06",
"SerialChannel07", "SerialChannel08", "SerialChannel09", "SerialChannel10", "SerialChannel11", "SerialChannel12", ],
ExternControlRoll => [ "",
"JoystickX", "JoystickX_Reverse", "JoystickY", "JoystickY_Reverse", "JoystickZ", "JoystickZ_Reverse",
"JoystickR", "JoystickR_Reverse", "JoystickU", "JoystickU_Reverse", "JoystickV", "JoystickV_Reverse",
"MouseRotX", "MouseRotX_Reverse", "MouseRotY", "MouseRotY_Reverse", "MouseRotZ", "MouseRotZ_Reverse",
"MouseTranX", "MouseTranX_Reverse", "MouseTranY", "MouseTranY_Reverse", "MouseTranZ", "MouseTranZ_Reverse",
"SerialChannel01", "SerialChannel02", "SerialChannel03", "SerialChannel04", "SerialChannel05", "SerialChannel06",
"SerialChannel07", "SerialChannel08", "SerialChannel09", "SerialChannel10", "SerialChannel11", "SerialChannel12", ],
ExternControlGier => [ "",
"JoystickX", "JoystickX_Reverse", "JoystickY", "JoystickY_Reverse", "JoystickZ", "JoystickZ_Reverse",
"JoystickR", "JoystickR_Reverse", "JoystickU", "JoystickU_Reverse", "JoystickV", "JoystickV_Reverse",
"MouseRotX", "MouseRotX_Reverse", "MouseRotY", "MouseRotY_Reverse", "MouseRotZ", "MouseRotZ_Reverse",
"MouseTranX", "MouseTranX_Reverse", "MouseTranY", "MouseTranY_Reverse", "MouseTranZ", "MouseTranZ_Reverse",
"SerialChannel01", "SerialChannel02", "SerialChannel03", "SerialChannel04", "SerialChannel05", "SerialChannel06",
"SerialChannel07", "SerialChannel08", "SerialChannel09", "SerialChannel10", "SerialChannel11", "SerialChannel12", ],
ExternControlGas => [ "",
"JoystickX", "JoystickX_Reverse", "JoystickY", "JoystickY_Reverse", "JoystickZ", "JoystickZ_Reverse",
"JoystickR", "JoystickR_Reverse", "JoystickU", "JoystickU_Reverse", "JoystickV", "JoystickV_Reverse",
"MouseRotX", "MouseRotX_Reverse", "MouseRotY", "MouseRotY_Reverse", "MouseRotZ", "MouseRotZ_Reverse",
"MouseTranX", "MouseTranX_Reverse", "MouseTranY", "MouseTranY_Reverse", "MouseTranZ", "MouseTranZ_Reverse",
"SerialChannel01", "SerialChannel02", "SerialChannel03", "SerialChannel04", "SerialChannel05", "SerialChannel06",
"SerialChannel07", "SerialChannel08", "SerialChannel09", "SerialChannel10", "SerialChannel11", "SerialChannel12", ],
ExternControlHeight => [ "",
"JoystickX", "JoystickX_Reverse", "JoystickY", "JoystickY_Reverse", "JoystickZ", "JoystickZ_Reverse",
"JoystickR", "JoystickR_Reverse", "JoystickU", "JoystickU_Reverse", "JoystickV", "JoystickV_Reverse",
"MouseRotX", "MouseRotX_Reverse", "MouseRotY", "MouseRotY_Reverse", "MouseRotZ", "MouseRotZ_Reverse",
"MouseTranX", "MouseTranX_Reverse", "MouseTranY", "MouseTranY_Reverse", "MouseTranZ", "MouseTranZ_Reverse",
"SerialChannel01", "SerialChannel02", "SerialChannel03", "SerialChannel04", "SerialChannel05", "SerialChannel06",
"SerialChannel07", "SerialChannel08", "SerialChannel09", "SerialChannel10", "SerialChannel11", "SerialChannel12", ],
SerialChannel01 => [ "",
"JoystickX", "JoystickX_Reverse", "JoystickY", "JoystickY_Reverse", "JoystickZ", "JoystickZ_Reverse",
"JoystickR", "JoystickR_Reverse", "JoystickU", "JoystickU_Reverse", "JoystickV", "JoystickV_Reverse",
"JoystickButton1", "JoystickButton2", "JoystickButton3", "JoystickButton4",
"JoystickButton5", "JoystickButton6", "JoystickButton7", "JoystickButton8",
"JoystickButton9", "JoystickButton10", "JoystickButton11", "JoystickButton12",
"JoystickPov0", "JoystickPov45", "JoystickPov90", "JoystickPov135",
"JoystickPov180", "JoystickPov225", "JoystickPov270", "JoystickPov315",
"MouseRotX", "MouseRotX_Reverse", "MouseRotY", "MouseRotY_Reverse", "MouseRotZ", "MouseRotZ_Reverse",
"MouseTranX", "MouseTranX_Reverse", "MouseTranY", "MouseTranY_Reverse", "MouseTranZ", "MouseTranZ_Reverse",
"MouseButton1", "MouseButton2", "MouseButton3", "MouseButton4", ],
SerialChannel02 => [ "",
"JoystickX", "JoystickX_Reverse", "JoystickY", "JoystickY_Reverse", "JoystickZ", "JoystickZ_Reverse",
"JoystickR", "JoystickR_Reverse", "JoystickU", "JoystickU_Reverse", "JoystickV", "JoystickV_Reverse",
"JoystickButton1", "JoystickButton2", "JoystickButton3", "JoystickButton4",
"JoystickButton5", "JoystickButton6", "JoystickButton7", "JoystickButton8",
"JoystickButton9", "JoystickButton10", "JoystickButton11", "JoystickButton12",
"JoystickPov0", "JoystickPov45", "JoystickPov90", "JoystickPov135",
"JoystickPov180", "JoystickPov225", "JoystickPov270", "JoystickPov315",
"MouseRotX", "MouseRotX_Reverse", "MouseRotY", "MouseRotY_Reverse", "MouseRotZ", "MouseRotZ_Reverse",
"MouseTranX", "MouseTranX_Reverse", "MouseTranY", "MouseTranY_Reverse", "MouseTranZ", "MouseTranZ_Reverse",
"MouseButton1", "MouseButton2", "MouseButton3", "MouseButton4", ],
SerialChannel03 => [ "",
"JoystickX", "JoystickX_Reverse", "JoystickY", "JoystickY_Reverse", "JoystickZ", "JoystickZ_Reverse",
"JoystickR", "JoystickR_Reverse", "JoystickU", "JoystickU_Reverse", "JoystickV", "JoystickV_Reverse",
"JoystickButton1", "JoystickButton2", "JoystickButton3", "JoystickButton4",
"JoystickButton5", "JoystickButton6", "JoystickButton7", "JoystickButton8",
"JoystickButton9", "JoystickButton10", "JoystickButton11", "JoystickButton12",
"JoystickPov0", "JoystickPov45", "JoystickPov90", "JoystickPov135",
"JoystickPov180", "JoystickPov225", "JoystickPov270", "JoystickPov315",
"MouseRotX", "MouseRotX_Reverse", "MouseRotY", "MouseRotY_Reverse", "MouseRotZ", "MouseRotZ_Reverse",
"MouseTranX", "MouseTranX_Reverse", "MouseTranY", "MouseTranY_Reverse", "MouseTranZ", "MouseTranZ_Reverse",
"MouseButton1", "MouseButton2", "MouseButton3", "MouseButton4", ],
SerialChannel04 => [ "",
"JoystickX", "JoystickX_Reverse", "JoystickY", "JoystickY_Reverse", "JoystickZ", "JoystickZ_Reverse",
"JoystickR", "JoystickR_Reverse", "JoystickU", "JoystickU_Reverse", "JoystickV", "JoystickV_Reverse",
"JoystickButton1", "JoystickButton2", "JoystickButton3", "JoystickButton4",
"JoystickButton5", "JoystickButton6", "JoystickButton7", "JoystickButton8",
"JoystickButton9", "JoystickButton10", "JoystickButton11", "JoystickButton12",
"JoystickPov0", "JoystickPov45", "JoystickPov90", "JoystickPov135",
"JoystickPov180", "JoystickPov225", "JoystickPov270", "JoystickPov315",
"MouseRotX", "MouseRotX_Reverse", "MouseRotY", "MouseRotY_Reverse", "MouseRotZ", "MouseRotZ_Reverse",
"MouseTranX", "MouseTranX_Reverse", "MouseTranY", "MouseTranY_Reverse", "MouseTranZ", "MouseTranZ_Reverse",
"MouseButton1", "MouseButton2", "MouseButton3", "MouseButton4", ],
SerialChannel05 => [ "",
"JoystickX", "JoystickX_Reverse", "JoystickY", "JoystickY_Reverse", "JoystickZ", "JoystickZ_Reverse",
"JoystickR", "JoystickR_Reverse", "JoystickU", "JoystickU_Reverse", "JoystickV", "JoystickV_Reverse",
"JoystickButton1", "JoystickButton2", "JoystickButton3", "JoystickButton4",
"JoystickButton5", "JoystickButton6", "JoystickButton7", "JoystickButton8",
"JoystickButton9", "JoystickButton10", "JoystickButton11", "JoystickButton12",
"JoystickPov0", "JoystickPov45", "JoystickPov90", "JoystickPov135",
"JoystickPov180", "JoystickPov225", "JoystickPov270", "JoystickPov315",
"MouseRotX", "MouseRotX_Reverse", "MouseRotY", "MouseRotY_Reverse", "MouseRotZ", "MouseRotZ_Reverse",
"MouseTranX", "MouseTranX_Reverse", "MouseTranY", "MouseTranY_Reverse", "MouseTranZ", "MouseTranZ_Reverse",
"MouseButton1", "MouseButton2", "MouseButton3", "MouseButton4", ],
SerialChannel06 => [ "",
"JoystickX", "JoystickX_Reverse", "JoystickY", "JoystickY_Reverse", "JoystickZ", "JoystickZ_Reverse",
"JoystickR", "JoystickR_Reverse", "JoystickU", "JoystickU_Reverse", "JoystickV", "JoystickV_Reverse",
"JoystickButton1", "JoystickButton2", "JoystickButton3", "JoystickButton4",
"JoystickButton5", "JoystickButton6", "JoystickButton7", "JoystickButton8",
"JoystickButton9", "JoystickButton10", "JoystickButton11", "JoystickButton12",
"JoystickPov0", "JoystickPov45", "JoystickPov90", "JoystickPov135",
"JoystickPov180", "JoystickPov225", "JoystickPov270", "JoystickPov315",
"MouseRotX", "MouseRotX_Reverse", "MouseRotY", "MouseRotY_Reverse", "MouseRotZ", "MouseRotZ_Reverse",
"MouseTranX", "MouseTranX_Reverse", "MouseTranY", "MouseTranY_Reverse", "MouseTranZ", "MouseTranZ_Reverse",
"MouseButton1", "MouseButton2", "MouseButton3", "MouseButton4", ],
SerialChannel07 => [ "",
"JoystickX", "JoystickX_Reverse", "JoystickY", "JoystickY_Reverse", "JoystickZ", "JoystickZ_Reverse",
"JoystickR", "JoystickR_Reverse", "JoystickU", "JoystickU_Reverse", "JoystickV", "JoystickV_Reverse",
"JoystickButton1", "JoystickButton2", "JoystickButton3", "JoystickButton4",
"JoystickButton5", "JoystickButton6", "JoystickButton7", "JoystickButton8",
"JoystickButton9", "JoystickButton10", "JoystickButton11", "JoystickButton12",
"JoystickPov0", "JoystickPov45", "JoystickPov90", "JoystickPov135",
"JoystickPov180", "JoystickPov225", "JoystickPov270", "JoystickPov315",
"MouseRotX", "MouseRotX_Reverse", "MouseRotY", "MouseRotY_Reverse", "MouseRotZ", "MouseRotZ_Reverse",
"MouseTranX", "MouseTranX_Reverse", "MouseTranY", "MouseTranY_Reverse", "MouseTranZ", "MouseTranZ_Reverse",
"MouseButton1", "MouseButton2", "MouseButton3", "MouseButton4", ],
SerialChannel08 => [ "",
"JoystickX", "JoystickX_Reverse", "JoystickY", "JoystickY_Reverse", "JoystickZ", "JoystickZ_Reverse",
"JoystickR", "JoystickR_Reverse", "JoystickU", "JoystickU_Reverse", "JoystickV", "JoystickV_Reverse",
"JoystickButton1", "JoystickButton2", "JoystickButton3", "JoystickButton4",
"JoystickButton5", "JoystickButton6", "JoystickButton7", "JoystickButton8",
"JoystickButton9", "JoystickButton10", "JoystickButton11", "JoystickButton12",
"JoystickPov0", "JoystickPov45", "JoystickPov90", "JoystickPov135",
"JoystickPov180", "JoystickPov225", "JoystickPov270", "JoystickPov315",
"MouseRotX", "MouseRotX_Reverse", "MouseRotY", "MouseRotY_Reverse", "MouseRotZ", "MouseRotZ_Reverse",
"MouseTranX", "MouseTranX_Reverse", "MouseTranY", "MouseTranY_Reverse", "MouseTranZ", "MouseTranZ_Reverse",
"MouseButton1", "MouseButton2", "MouseButton3", "MouseButton4", ],
SerialChannel09 => [ "",
"JoystickX", "JoystickX_Reverse", "JoystickY", "JoystickY_Reverse", "JoystickZ", "JoystickZ_Reverse",
"JoystickR", "JoystickR_Reverse", "JoystickU", "JoystickU_Reverse", "JoystickV", "JoystickV_Reverse",
"JoystickButton1", "JoystickButton2", "JoystickButton3", "JoystickButton4",
"JoystickButton5", "JoystickButton6", "JoystickButton7", "JoystickButton8",
"JoystickButton9", "JoystickButton10", "JoystickButton11", "JoystickButton12",
"JoystickPov0", "JoystickPov45", "JoystickPov90", "JoystickPov135",
"JoystickPov180", "JoystickPov225", "JoystickPov270", "JoystickPov315",
"MouseRotX", "MouseRotX_Reverse", "MouseRotY", "MouseRotY_Reverse", "MouseRotZ", "MouseRotZ_Reverse",
"MouseTranX", "MouseTranX_Reverse", "MouseTranY", "MouseTranY_Reverse", "MouseTranZ", "MouseTranZ_Reverse",
"MouseButton1", "MouseButton2", "MouseButton3", "MouseButton4", ],
SerialChannel10 => [ "",
"JoystickX", "JoystickX_Reverse", "JoystickY", "JoystickY_Reverse", "JoystickZ", "JoystickZ_Reverse",
"JoystickR", "JoystickR_Reverse", "JoystickU", "JoystickU_Reverse", "JoystickV", "JoystickV_Reverse",
"JoystickButton1", "JoystickButton2", "JoystickButton3", "JoystickButton4",
"JoystickButton5", "JoystickButton6", "JoystickButton7", "JoystickButton8",
"JoystickButton9", "JoystickButton10", "JoystickButton11", "JoystickButton12",
"JoystickPov0", "JoystickPov45", "JoystickPov90", "JoystickPov135",
"JoystickPov180", "JoystickPov225", "JoystickPov270", "JoystickPov315",
"MouseRotX", "MouseRotX_Reverse", "MouseRotY", "MouseRotY_Reverse", "MouseRotZ", "MouseRotZ_Reverse",
"MouseTranX", "MouseTranX_Reverse", "MouseTranY", "MouseTranY_Reverse", "MouseTranZ", "MouseTranZ_Reverse",
"MouseButton1", "MouseButton2", "MouseButton3", "MouseButton4", ],
SerialChannel11 => [ "",
"JoystickX", "JoystickX_Reverse", "JoystickY", "JoystickY_Reverse", "JoystickZ", "JoystickZ_Reverse",
"JoystickR", "JoystickR_Reverse", "JoystickU", "JoystickU_Reverse", "JoystickV", "JoystickV_Reverse",
"JoystickButton1", "JoystickButton2", "JoystickButton3", "JoystickButton4",
"JoystickButton5", "JoystickButton6", "JoystickButton7", "JoystickButton8",
"JoystickButton9", "JoystickButton10", "JoystickButton11", "JoystickButton12",
"JoystickPov0", "JoystickPov45", "JoystickPov90", "JoystickPov135",
"JoystickPov180", "JoystickPov225", "JoystickPov270", "JoystickPov315",
"MouseRotX", "MouseRotX_Reverse", "MouseRotY", "MouseRotY_Reverse", "MouseRotZ", "MouseRotZ_Reverse",
"MouseTranX", "MouseTranX_Reverse", "MouseTranY", "MouseTranY_Reverse", "MouseTranZ", "MouseTranZ_Reverse",
"MouseButton1", "MouseButton2", "MouseButton3", "MouseButton4", ],
SerialChannel12 => [ "",
"JoystickX", "JoystickX_Reverse", "JoystickY", "JoystickY_Reverse", "JoystickZ", "JoystickZ_Reverse",
"JoystickR", "JoystickR_Reverse", "JoystickU", "JoystickU_Reverse", "JoystickV", "JoystickV_Reverse",
"JoystickButton1", "JoystickButton2", "JoystickButton3", "JoystickButton4",
"JoystickButton5", "JoystickButton6", "JoystickButton7", "JoystickButton8",
"JoystickButton9", "JoystickButton10", "JoystickButton11", "JoystickButton12",
"JoystickPov0", "JoystickPov45", "JoystickPov90", "JoystickPov135",
"JoystickPov180", "JoystickPov225", "JoystickPov270", "JoystickPov315",
"MouseRotX", "MouseRotX_Reverse", "MouseRotY", "MouseRotY_Reverse", "MouseRotZ", "MouseRotZ_Reverse",
"MouseTranX", "MouseTranX_Reverse", "MouseTranY", "MouseTranY_Reverse", "MouseTranZ", "MouseTranZ_Reverse",
"MouseButton1", "MouseButton2", "MouseButton3", "MouseButton4", ],
);
1;
__END__

/MissionCockpit/tags/V0.4.0/libjoystick.pl
0,0 → 1,146
#!/usr/bin/perl
#!/usr/bin/perl -d:ptkdb
###############################################################################
#
# libjoystick.pl - Joystick controls
#
# Copyright (C) 2009 Rainer Walther (rainerwalther-mail@web.de)
#
# Creative Commons Lizenz mit den Zusaetzen (by, nc, sa)
#
# Es ist Ihnen gestattet:
# * das Werk vervielfältigen, verbreiten und öffentlich zugänglich machen
# * Abwandlungen bzw. Bearbeitungen des Inhaltes anfertigen
#
# Zu den folgenden Bedingungen:
# * Namensnennung.
# Sie müssen den Namen des Autors/Rechteinhabers in der von ihm festgelegten Weise nennen.
# * Keine kommerzielle Nutzung.
# Dieses Werk darf nicht für kommerzielle Zwecke verwendet werden.
# * Weitergabe unter gleichen Bedingungen.
# Wenn Sie den lizenzierten Inhalt bearbeiten oder in anderer Weise umgestalten,
# verändern oder als Grundlage für einen anderen Inhalt verwenden,
# dürfen Sie den neu entstandenen Inhalt nur unter Verwendung von Lizenzbedingungen
# weitergeben, die mit denen dieses Lizenzvertrages identisch oder vergleichbar sind.
#
# Im Falle einer Verbreitung müssen Sie anderen die Lizenzbedingungen, unter welche dieses
# Werk fällt, mitteilen. Am Einfachsten ist es, einen Link auf diese Seite einzubinden.
#
# Jede der vorgenannten Bedingungen kann aufgehoben werden, sofern Sie die Einwilligung
# des Rechteinhabers dazu erhalten.
#
# Diese Lizenz lässt die Urheberpersönlichkeitsrechte unberührt.
#
# Weitere Details zur Lizenzbestimmung gibt es hier:
# Kurzform: http://creativecommons.org/licenses/by-nc-sa/3.0/de/
# Komplett: http://creativecommons.org/licenses/by-nc-sa/3.0/de/legalcode
#
###############################################################################
#
# 2009-12-06 0.0.1 rw created
#
###############################################################################
$Version{'libjoystick.pl'} = "0.0.1 - 2009-12-06";
# Packages
use threads; # http://search.cpan.org/~jdhedden/threads-1.72/threads.pm
# http://perldoc.perl.org/threads.html
use threads::shared; # http://search.cpan.org/~jdhedden/threads-shared-1.28/shared.pm
use Time::HiRes qw(usleep); # http://search.cpan.org/~jhi/Time-HiRes-1.9719/HiRes.pm
use Win32::MultiMedia::Joystick; # http://aspn.activestate.com/ASPN/CodeDoc/Win32-MultiMedia/Joystick/Joystick.html
# Hashes exported to other threads and main-program
share (%Stick);
my $StickNum = "JOY1";
my $StickRange = 1024; # global stick range
$Stick{'StickRange'} = $StickRange;
$Stick{'JoystickX'} = 512;
$Stick{'JoystickY'} = 512;
$Stick{'JoystickZ'} = 512;
$Stick{'JoystickR'} = 512;
$Stick{'JoystickU'} = 512;
$Stick{'JoystickV'} = 512;
$Stick{'JoystickButton'} = 0;
$Stick{'JoystickPov'} = 0xffff;
$Stick{'_JoystickTimestamp'} = time;
my $Joystick = Win32::MultiMedia::Joystick->new($StickNum);
if ( defined $Joystick )
{
$StickNumAxes = $Joystick->NumAxes;
$StickNumButtons = $Joystick->NumButtons;
$StickXmin = $Joystick->Xmin;
$StickXmax = $Joystick->Xmax;
$StickYmin = $Joystick->Ymin;
$StickYmax = $Joystick->Ymax;
$StickZmin = $Joystick->Zmin;
$StickZmax = $Joystick->Zmax;
$StickRmin = $Joystick->Rmin;
$StickRmax = $Joystick->Rmax;
$StickUmin = $Joystick->Umin;
$StickUmax = $Joystick->Umax;
$StickVmin = $Joystick->Vmin;
$StickVmax = $Joystick->Vmax;
$Stick{'JoystickAxes'} = $StickNumAxes;
$Stick{'JoystickNumButtons'} = $StickNumButtons;
$Stick{'_JoystickTimestamp'} = time;
}
sub Joystick()
{
while ( usleep (10000) ) # 10ms loop
{
if ( defined $Joystick and $Stick{'JoystickAxes'} > 0)
{
$Joystick->update;
my $x = $Joystick->X;
my $y = $Joystick->Y;
my $z = $Joystick->Z;
my $r = $Joystick->R;
my $u = $Joystick->U;
my $v = $Joystick->V;
my $Button = $Joystick->Buttons;
my $Pov = $Joystick->POV;
lock (%Stick); # until end of block
$Stick{'JoystickX'} = int ($x / ($StickXmax - $StickXmin) * $StickRange + 0.5);
$Stick{'JoystickY'} = $StickRange - int ($y / ($StickYmax - $StickYmin) * $StickRange + 0.5);
$Stick{'JoystickZ'} = $StickRange - int ($z / ($StickYmax - $StickYmin) * $StickRange + 0.5);
$Stick{'JoystickR'} = int ($r / ($StickRmax - $StickRmin) * $StickRange + 0.5);
$Stick{'JoystickU'} = int ($u / ($StickUmax - $StickUmin) * $StickRange + 0.5);
$Stick{'JoystickV'} = int ($v / ($StickVmax - $StickVmin) * $StickRange + 0.5);
$Stick{'JoystickButton'} = $Button;
$Stick{'JoystickPov'} = $Pov;
$Stick{'_JoystickTimestamp'} = time;
}
}
}
sub JoystickStop ()
{
# Nothing to do
}
# check, if button "Num" pressed, Num = 0 .. n
sub JoystickButton()
{
my ($Num) = @_;
return (($Stick{'JoystickButton'} >> $Num) & 1) == 1;
}
1;
__END__

/MissionCockpit/tags/V0.4.0/libmap.pl
0,0 → 1,213
#!/usr/bin/perl
#!/usr/bin/perl -d:ptkdb
###############################################################################
#
# libmap.pl - Conversion GPS and Map-X/Y Coordinates
#
# Copyright (C) 2009 Rainer Walther (rainerwalther-mail@web.de)
#
# Creative Commons Lizenz mit den Zusaetzen (by, nc, sa)
#
# Es ist Ihnen gestattet:
# * das Werk vervielfältigen, verbreiten und öffentlich zugänglich machen
# * Abwandlungen bzw. Bearbeitungen des Inhaltes anfertigen
#
# Zu den folgenden Bedingungen:
# * Namensnennung.
# Sie müssen den Namen des Autors/Rechteinhabers in der von ihm festgelegten Weise nennen.
# * Keine kommerzielle Nutzung.
# Dieses Werk darf nicht für kommerzielle Zwecke verwendet werden.
# * Weitergabe unter gleichen Bedingungen.
# Wenn Sie den lizenzierten Inhalt bearbeiten oder in anderer Weise umgestalten,
# verändern oder als Grundlage für einen anderen Inhalt verwenden,
# dürfen Sie den neu entstandenen Inhalt nur unter Verwendung von Lizenzbedingungen
# weitergeben, die mit denen dieses Lizenzvertrages identisch oder vergleichbar sind.
#
# Im Falle einer Verbreitung müssen Sie anderen die Lizenzbedingungen, unter welche dieses
# Werk fällt, mitteilen. Am Einfachsten ist es, einen Link auf diese Seite einzubinden.
#
# Jede der vorgenannten Bedingungen kann aufgehoben werden, sofern Sie die Einwilligung
# des Rechteinhabers dazu erhalten.
#
# Diese Lizenz lässt die Urheberpersönlichkeitsrechte unberührt.
#
# Weitere Details zur Lizenzbestimmung gibt es hier:
# Kurzform: http://creativecommons.org/licenses/by-nc-sa/3.0/de/
# Komplett: http://creativecommons.org/licenses/by-nc-sa/3.0/de/legalcode
#
###############################################################################
#
# 2009-03-06 0.0.1 rw created
# 2009-04-01 0.1.0 rw RC1
# 2009-05-13 0.1.1 rw MapGpsAt() added
# 2009-05-22 0.1.2 rw add default Map dir
# 2009-07-22 0.1.3 rw Map Offset_x, Offset_y added
# 2009-08-08 0.1.4 rw atan -> atan2
# 2009-11-04 0.1.5 rw Lon > 180
#
###############################################################################
$Version{'libmap.pl'} = "0.1.4 - 2009-08-08";
use Geo::Ellipsoid; # http://search.cpan.org/dist/Geo-Ellipsoid-1.12/lib/Geo/Ellipsoid.pm
use Math::Trig;
if ( ! defined Cfg->{'map'}->{'MapDir'} )
{
# set default map directory
$Cfg->{'map'}->{'MapDir'} = "map";
}
require "$Cfg->{'map'}->{'MapDir'}/map.pl"; # Landkarte
#
# Convert GPS (Lat,Lon) to pixel coordinates in map
#
sub MapGps2XY ()
{
my ($Lat, $Lon, $Bearing) = @_;
# Aktuell gültige Karte
my %Map = %{$Maps{'Current'}};
my $Map_Geo = Geo::Ellipsoid->new( 'units' => 'degrees',
'distance_units' => 'meter',
'ellipsoid' => 'WGS84',
'longitude' => 1, # Symmetric: -pi..pi
);
# P1 -> P2: Entfernung und Richtung
my ($P1P2_Dist_m, $P1P2_Bearing) = $Map_Geo->to( $Map{'P1_Lat'}, $Map{'P1_Lon'}, $Map{'P2_Lat'}, $Map{'P2_Lon'} );
my $dx_p = $Map{'P2_x'} - $Map{'P1_x'};
my $dy_p = $Map{'P2_y'} - $Map{'P1_y'};
my $P1P2_Dist_p = sqrt($dx_p*$dx_p + $dy_p*$dy_p);
my $PixRes = $P1P2_Dist_m / $P1P2_Dist_p ; # 1 Pixel = $PixRes Meter
my $Phi = rad2deg atan2 ($dy_p, $dx_p);
my $PhiRef = $P1P2_Bearing - $Phi; # Winkel zwischen N und Bild-Horizont
# P1 -> Target: Entfernung und Richtung
my ($T_Dist_m, $T_Bearing) = $Map_Geo->to( $Map{'P1_Lat'}, $Map{'P1_Lon'}, $Lat, $Lon );
my $Alpha = deg2rad($T_Bearing - $PhiRef); # Winkel zw. Bild-Horizont und Target
my $T_dx_p = cos($Alpha) * $T_Dist_m / $PixRes;
my $T_dy_p = sin($Alpha) * $T_Dist_m / $PixRes;
my $X_p = $Map{'P1_x'} + $T_dx_p + $Map{'Offset_x'};
my $Y_p = $Map{'P1_y'} + $T_dy_p - $Map{'Offset_y'};
# map calibration adjustment
$X_p += $Map{'Offset_x'};
$Y_p -= $Map{'Offset_y'};
$Angel = $Bearing - $PhiRef;
return ($X_p, $Y_p, $Angel);
}
#
# Convert pixel coordinates in map to GPS (Lat,Lon)
#
sub MapXY2Gps ()
{
my ($X, $Y) = @_;
# Aktuell gültige Karte
my %Map = %{$Maps{'Current'}};
# map calibration adjustment
$X -= $Map{'Offset_x'};
$Y += $Map{'Offset_y'};
my $Map_Geo = Geo::Ellipsoid->new( 'units' => 'degrees',
'distance_units' => 'meter',
'ellipsoid' => 'WGS84',
'longitude' => 1, # Symmetric: -pi..pi
);
# P1 -> P2: Entfernung und Richtung
my ($P1P2_Dist_m, $P1P2_Bearing) = $Map_Geo->to( $Map{'P1_Lat'}, $Map{'P1_Lon'}, $Map{'P2_Lat'}, $Map{'P2_Lon'} );
my $dx_p = $Map{'P2_x'} - $Map{'P1_x'};
my $dy_p = $Map{'P2_y'} - $Map{'P1_y'};
my $P1P2_Dist_p = sqrt($dx_p*$dx_p + $dy_p*$dy_p);
my $PixRes = $P1P2_Dist_m / $P1P2_Dist_p ; # 1 Pixel = $PixRes Meter
my $Phi = rad2deg atan2 ($dy_p, $dx_p);
my $PhiRef = $P1P2_Bearing - $Phi; # Winkel zwischen N und Bild-Horizont
my $dx = $X - $Map{'P1_x'};
my $dy = $Y - $Map{'P1_y'};
my $Phi = rad2deg atan2 ($dy, $dx);
my $Bearing = $PhiRef + $Phi;
my $Dist = $PixRes * sqrt($dx*$dx + $dy*$dy);
my ($Lat, $Lon) = $Map_Geo->at( $Map{'P1_Lat'}, $Map{'P1_Lon'}, $Dist, $Bearing );
return ($Lat, $Lon);
}
#
# Get Bearing, Distance from 2 GPS Points
#
sub MapGpsTo()
{
my ($Lat1, $Lon1, $Lat2, $Lon2) = @_;
my $Map_Geo = Geo::Ellipsoid->new( 'units' => 'degrees',
'distance_units' => 'meter',
'ellipsoid' => 'WGS84',
'longitude' => 1, # Symmetric: -pi..pi
);
my ($Dist, $Bearing) = $Map_Geo->to( $Lat1, $Lon1, $Lat2, $Lon2);
return ($Dist, $Bearing);
}
#
# Get Target from GPS-Point, Bearing, Distance
#
sub MapGpsAt()
{
my ($Lat, $Lon, $Dist, $Bearing) = @_;
my $Map_Geo = Geo::Ellipsoid->new( 'units' => 'degrees',
'distance_units' => 'meter',
'ellipsoid' => 'WGS84',
'longitude' => 1, # Symmetric: -pi..pi
);
my ($Target_Lat, $Target_Lon) = $Map_Geo->at( $Lat, $Lon, $Dist, $Bearing);
return ($Target_Lat, $Target_Lon);
}
# Angel geographic North to Map Horizont
sub MapAngel()
{
# Aktuell gültige Karte
my %Map = %{$Maps{'Current'}};
my $Map_Geo = Geo::Ellipsoid->new( 'units' => 'degrees',
'distance_units' => 'meter',
'ellipsoid' => 'WGS84',
'longitude' => 1, # Symmetric: -pi..pi
);
# P1 -> P2: Entfernung und Richtung
my ($P1P2_Dist_m, $P1P2_Bearing) = $Map_Geo->to( $Map{'P1_Lat'}, $Map{'P1_Lon'}, $Map{'P2_Lat'}, $Map{'P2_Lon'} );
my $dx_p = $Map{'P2_x'} - $Map{'P1_x'};
my $dy_p = $Map{'P2_y'} - $Map{'P1_y'};
my $Phi = rad2deg atan2 ($dy_p, $dx_p);
my $PhiRef = $P1P2_Bearing - $Phi; # Winkel zwischen N und Bild-Horizont
return ($PhiRef);
}
1;
__END__

/MissionCockpit/tags/V0.4.0/libmkcockpit.pl
0,0 → 1,2720
#!/usr/bin/perl
#!/usr/bin/perl -d:ptkdb
###############################################################################
#
# libmkcockpit.pl - MK Mission Cockpit - Subroutined for GUI Frontend
#
# Copyright (C) 2009 Rainer Walther (rainerwalther-mail@web.de)
#
# Creative Commons Lizenz mit den Zusaetzen (by, nc, sa)
#
# Es ist Ihnen gestattet:
# * das Werk vervielfältigen, verbreiten und öffentlich zugänglich machen
# * Abwandlungen bzw. Bearbeitungen des Inhaltes anfertigen
#
# Zu den folgenden Bedingungen:
# * Namensnennung.
# Sie müssen den Namen des Autors/Rechteinhabers in der von ihm festgelegten Weise nennen.
# * Keine kommerzielle Nutzung.
# Dieses Werk darf nicht für kommerzielle Zwecke verwendet werden.
# * Weitergabe unter gleichen Bedingungen.
# Wenn Sie den lizenzierten Inhalt bearbeiten oder in anderer Weise umgestalten,
# verändern oder als Grundlage für einen anderen Inhalt verwenden,
# dürfen Sie den neu entstandenen Inhalt nur unter Verwendung von Lizenzbedingungen
# weitergeben, die mit denen dieses Lizenzvertrages identisch oder vergleichbar sind.
#
# Im Falle einer Verbreitung müssen Sie anderen die Lizenzbedingungen, unter welche dieses
# Werk fällt, mitteilen. Am Einfachsten ist es, einen Link auf diese Seite einzubinden.
#
# Jede der vorgenannten Bedingungen kann aufgehoben werden, sofern Sie die Einwilligung
# des Rechteinhabers dazu erhalten.
#
# Diese Lizenz lässt die Urheberpersönlichkeitsrechte unberührt.
#
# Weitere Details zur Lizenzbestimmung gibt es hier:
# Kurzform: http://creativecommons.org/licenses/by-nc-sa/3.0/de/
# Komplett: http://creativecommons.org/licenses/by-nc-sa/3.0/de/legalcode
#
###############################################################################
# 2009-08-09 0.2.5 rw subroutines moved from mkcockpit.pl
# 2009-09-05 0.2.6 rw POI heading control added
# 2009-10-10 0.2.7 rw Layout Config-dialog
# Fix Message-Balloon in KML-Mode
# 2009-10-25 0.3.0 rw NC 0.17
# Read/Write KopterTool WPL Waypoint list
# configuration Combo Box
# 2010-02-10 0.4.0 rw Show Grid on map
# Show crosshair in player pause mode
# joystick and 3D-Mouse support
# Cfg file selection dialog
# serial channel
# Event engine
# External control - Limit, expo
# Resize WP-Icon to 24x48 pixel
#
###############################################################################
$Version{'libmkcockpit.pl'} = "0.4.0 - 2010-02-10";
# check, if %MkOsd is valid
sub MkOsdIsValid()
{
return ( $MkOsd{'_Timestamp'} >= time-2 );
}
# check, if current GPS position is valid
sub CurPosIsValid()
{
return ( &MkOsdIsValid() and $MkOsd{'SatsInUse'} >= 6 and $MkOsd{'CurPos_Stat'} == 1 );
}
# check, if home GPS position is valid
sub HomePosIsValid()
{
return ( &MkOsdIsValid() and $MkOsd{'SatsInUse'} >= 6 and $MkOsd{'HomePos_Stat'} == 1 );
}
# check, if target GPS position is valid
sub TargetIsValid()
{
return ( &MkOsdIsValid() and $MkOsd{'SatsInUse'} >= 6 and $MkOsd{'TargetPos_Stat'} == 1 );
}
# check, if motor are on
sub MkIsMotorOn()
{
return ( &MkOsdIsValid() and $MkOsd{'MKFlags'} & 0x01 );
}
# check, if MK is flying
sub MkIsFlying()
{
return ( &MkOsdIsValid() and $MkOsd{'MKFlags'} & 0x02 );
}
# check, if MK is calibrating
sub MkIsCalibrating()
{
return ( &MkOsdIsValid() and $MkOsd{'MKFlags'} & 0x04 );
}
# check, if Motor is starting
sub MkIsMotorStarting()
{
return ( &MkOsdIsValid() and $MkOsd{'MKFlags'} & 0x08 );
}
# check, Emergency Landing
sub MkEmergencyLanding()
{
return ( &MkOsdIsValid() and $MkOsd{'MKFlags'} & 0x10 );
}
# check, if MK is FREE Mode
sub MkIsFreeMode()
{
return ( &MkOsdIsValid() and $MkOsd{'NCFlags'} & 0x01 );
}
# check, if MK is in PH Mode
sub MkIsPhMode()
{
return ( &MkOsdIsValid() and $MkOsd{'NCFlags'} & 0x02 );
}
# check, if MK is in WPT Mode
sub MkIsWptMode()
{
return ( &MkOsdIsValid() and $MkOsd{'NCFlags'} & 0x04 );
}
# check, Range Limit
sub MkRangeLimit()
{
return ( &MkOsdIsValid() and $MkOsd{'NCFlags'} & 0x08 );
}
# check, Serial Link
sub MkSerialLink()
{
return ( &MkOsdIsValid() and $MkOsd{'NCFlags'} & 0x10 );
}
# check, Target reached
sub MkTargetReached()
{
return ( &MkOsdIsValid() and $MkOsd{'NCFlags'} & 0x20 );
}
# check, Manual Control
sub MkManualControl()
{
return ( &MkOsdIsValid() and $MkOsd{'NCFlags'} & 0x40 );
}
# Get altitude (hoehensensor)
sub AltitudeAir ()
{
return ( $MkOsd{'Altimeter'} / $Cfg->{'mkcockpit'}->{'AltFactor'} );
}
# Get altitude (GPS)
sub AltitudeGPS ()
{
return ( $MkOsd{'CurPos_Alt'} - $MkOsd{'HomePos_Alt'} );
}
# Get altitude (average hoehensensor , GPS)
sub Altitude ()
{
my $Alt = ( 4 * &AltitudeAir + &AltitudeGPS ) / 5;
return ($Alt);
}
# range 0 .. 255
sub CheckUnsignedChar()
{
my ($U8) = @_;
if ( $U8 < 0) { $U8 = 0; };
if ( $U8 > 255) { $U8 = 255; };
return $U8;
}
# range -128 .. 127
sub CheckSignedChar()
{
my ($S8) = @_;
if ( $S8 < -128) { $S8 = -128; };
if ( $S8 > 127) { $S8 = 127; };
return $S8;
}
# Set serial Channel value. Num: 0..11, Val: -128..0..127
sub SerialChannel()
{
my ($Num, $Val) = @_;
my $Key = sprintf ("SerialChannel%02d", $Num + 1);
lock (%MkSerialChannel); # until end of block
$MkSerialChannel{$Key} = &CheckSignedChar($Val);
# timestamp, when channel value was set
$MkSerialChannel{'_Timestamp'} = time;
}
# Limit: 0% .. 100%
# Expo : -100% .. 0 .. 100%
sub ExpoLimit ()
{
my ($StickMin, $StickMax, $Stick, $Expo, $Limit) = @_;
if ( $Expo ne "" )
{
# neg. Expo: 1..0.2 (0% .. -100%)
# pos. Expo: 1..5 (0% .. 100%)
if ( $Expo >= 0 )
{
$Expo = 1 + $Expo / 100 * 5;
}
else
{
$Expo = 1 - $Expo / 100 / 5;
}
if( $Stick >= 0 )
{
$Stick = $StickMax * ( $Stick ** $Expo ) / ( $StickMax ** $Expo);
}
else
{
$Stick = $StickMin * ( (- $Stick) ** $Expo ) / ( (- $StickMin) ** $Expo);
}
}
if ( $Limit ne "" )
{
$Stick = $Stick * $Limit / 100;
}
return ($Stick);
}
# get battery capacity in %
sub BatCapacity()
{
my ($UBat) = @_;
my $CfgVal = $Cfg->{'mkcockpit'}->{'BatCharacteristics'};
my @Voltage = split ' ', $CfgVal;
my $Capacity = 0;
if ( $UBat >= $Voltage[0] )
{
$Capacity = 100;
}
$Cnt = $#Voltage;
for ($i=0; $i < $Cnt; $i++)
{
my $V1 = $Voltage[$i];
my $V2 = $Voltage[$i+1];
if ( $UBat >= $V1 and $UBat < $V2 or
$UBat <= $V1 and $UBat > $V2 )
{
# linear interpolation
my $x = $i + ($UBat - $V1 ) / ($V2 - $V1);
$Capacity = 100 - $x * 100 / $Cnt;
last;
}
}
return $Capacity;
}
#
# Waypoint handling
#
# Add a Waypoint to @Waypoints List
sub WpAdd()
{
my %Param = @_;
my $Wp_x = $Param{'-x'};
my $Wp_y = $Param{'-y'};
my $Lat = $Param{'-lat'};
my $Lon = $Param{'-lon'};
# x/y and/or Lat/Lon must be passed
if ( $Wp_x eq "" and $Wp_y eq "" )
{
($Wp_x, $Wp_y) = &MapGps2XY($Lat, $Lon);
}
if ( $Lat eq "" and $Lon eq "" )
{
($Lat, $Lon) = &MapXY2Gps($Wp_x, $Wp_y);
}
# save Wp-Hash in Waypoint-Array
my $Wp = {};
# kind of unique Tag for this Wp
my ($t0_s, $t0_us) = gettimeofday;
my $Tag = sprintf "WP-%d.%d", $t0_s, $t0_us;
$Wp->{'Tag'} = $Tag;
$Wp->{'MapX'} = $Wp_x;
$Wp->{'MapY'} = $Wp_y;
$Wp->{'Pos_Lat'} = $Lat;
$Wp->{'Pos_Lon'} = $Lon;
$Wp->{'Pos_Alt'} = $MkOsd{'CurPos_Alt'};
$Wp->{'Heading'} = $Cfg->{'waypoint'}->{'DefaultHeading'};
$Wp->{'ToleranceRadius'} = $Cfg->{'waypoint'}->{'DefaultToleranceRadius'};
$Wp->{'Holdtime'} = $Cfg->{'waypoint'}->{'DefaultHoldtime'};
$Wp->{'Event_Flag'} = $Cfg->{'waypoint'}->{'DefaultEventFlag'};
push @Waypoints, $Wp;
}
# Delete Waypoint from @Waypoints List
sub WpDelete ()
{
my ($WpIndex) = @_;
# delete Wp in Waypoint-Array
splice @Waypoints, $WpIndex, 1;
}
# Delete all Waypoints
sub WpDeleteAll ()
{
undef @Waypoints;
$WpPlayerIndex = 0;
$WpPlayerHoldtime = -1;
# remove all Wp-Icons and Wp-Number on canvas
&WpHide();
}
# Load @Waypoints from file
sub WpLoadFile ()
{
my ($WpFile) = @_;
if ( $WpFile =~ /.wpl$/i )
{
# load Mikrokopter Tool WP List *.wpl
my $WpCnt = 0;
my $WpIndex = 0;
my @WpWpl;
open WPL, "<$WpFile";
my @Wpl = <WPL>;
close WPL;
foreach my $Line (@Wpl)
{
chomp $Line;
if ( $Line =~ /NumberOfWaypoints\s*=\s*(\d*)/i )
{
$WpCnt = $1;
}
elsif ( $Line =~ /\[Waypoint(\d*)\]/i )
{
$WpIndex = $1;
}
elsif ( $Line =~ /(\S*)\s*=\s*(\S*)/i )
{
my $Key = $1;
my $Value = $2;
$WpWpl[$WpIndex]{$Key} = $Value;
}
}
# WPL Array in Waypoints-Array umkopieren
undef @Waypoints;
for ( $Index=0; $Index < $WpCnt; $Index++)
{
my $Wp = {};
my $Tag = sprintf "Waypoint-%d.%d", time, $Index + 1; # kind of unique Tag for this Wp
my $Lat = $WpWpl[$Index]{'Latitude'};
my $Lon = $WpWpl[$Index]{'Longitude'};
($MapX, $MapY) = &MapGps2XY($Lat, $Lon);
$Wp->{'Tag'} = $Tag;
$Wp->{'MapX'} = $MapX;
$Wp->{'MapY'} = $MapY;
$Wp->{'Pos_Lat'} = $Lat;
$Wp->{'Pos_Lon'} = $Lon;
$Wp->{'Pos_Alt'} = $MkOsd{'CurPos_Alt'};
$Wp->{'Heading'} = $Cfg->{'waypoint'}->{'DefaultHeading'};
$Wp->{'ToleranceRadius'} = $WpWpl[$Index]{'Radius'};
$Wp->{'Holdtime'} = $WpWpl[$Index]{'DelayTime'};
$Wp->{'Event_Flag'} = $Cfg->{'waypoint'}->{'DefaultEventFlag'};
push @Waypoints, $Wp;
}
}
else
{
# load Mission Cockpit XML
# XML in Hash-Ref lesen
my $Wp = XMLin($WpFile, ForceArray => 1);
# XML Hash-Ref in Wp-Array umkopieren
undef @Waypoints;
foreach $key (sort keys %$Wp)
{
my $Point = $Wp->{$key}->[0];
# relative Pixelkoordinaten auf Bildgroesse umrechnen
if ( $Point->{'MapX'} <= 1 and $Point->{'MapY'} <= 1 )
{
$Point->{'MapX'} = int ( $Point->{'MapX'} * $MapSizeX + 0.5 );
$Point->{'MapY'} = int ( $Point->{'MapY'} * $MapSizeY + 0.5 );
}
# abs. pixel koordinates not needed
delete $Point->{'MapX_Pixel'};
delete $Point->{'MapY_Pixel'};
# GPS Koordinaten für die aktuelle Karte neu aus Map x/y berechnen
my ($Lat, $Lon) = &MapXY2Gps($Point->{'MapX'}, $Point->{'MapY'});
$Point->{'Pos_Lat'} = $Lat;
$Point->{'Pos_Lon'} = $Lon;
push @Waypoints, $Point;
}
}
# Start with 1st WP
&WpTargetFirst();
}
# Save @Waypoints to file
sub WpSaveFile()
{
my ($WpFile) = @_;
if ( $WpFile =~ /.wpl$/i )
{
# save Mikrokopter Tool WP List *.wpl
open WPL, ">$WpFile";
my $WpCnt = scalar @Waypoints;
print WPL "[General\]\n";
print WPL "FileVersion=1\n";
print WPL "NumberOfWaypoints=$WpCnt\n";
for $i ( 0 .. $#Waypoints )
{
print WPL "\[Waypoint${i}\]\n";
print WPL "Latitude=$Waypoints[$i]{'Pos_Lat'}\n";
print WPL "Longitude=$Waypoints[$i]{'Pos_Lon'}\n";
print WPL "Radius=$Waypoints[$i]{'ToleranceRadius'}\n";
print WPL "DelayTime=$Waypoints[$i]{'Holdtime'}\n";
}
close WPL;
}
else
{
# save Mission Cockpit XML
# Waypoint-Array in Hash umkopieren
for $i ( 0 .. $#Waypoints )
{
my $key = sprintf ("WP-%04d", $i);
my $Wp = {%{$Waypoints[$i]}}; # copy of Hash-content
$WpOut{$key} = $Wp;
# Pixelkoordinaten relativ zur Bildgroesse speichern
$WpOut{$key}{'MapX_Pixel'} = $WpOut{$key}{'MapX'};
$WpOut{$key}{'MapY_Pixel'} = $WpOut{$key}{'MapY'};
$WpOut{$key}{'MapX'} /= $MapSizeX;
$WpOut{$key}{'MapY'} /= $MapSizeY;
}
# WP-Hash als XML speichern
&XMLout (\%WpOut,
'OutputFile' => $WpFile,
'AttrIndent' => '1',
'RootName' => 'Waypoints',
);
}
}
# Get Wp Index from Canvas Id
sub WpGetIndexFromId()
{
my ($id) = @_;
my @Tags = $map_canvas->gettags($id);
my $WpTag = $Tags[1];
for $i (0 .. $#Waypoints)
{
my $Wp = $Waypoints[$i];
if ( $Wp->{'Tag'} eq $WpTag )
{
# got it
return $i;
}
}
return -1;
}
# Resend all Waypoints to MK
sub WpSendAll()
{
# OSD/Debug Abfragefrequenz verringern, sonst kommen nicht alle Wp im MK an
# Sicherheitshalber doppelt senden
$MkSendWp = 1; # verhindert ueberschreiben im Timer
$MkSendQueue->enqueue( "o", "$AddrNC", pack ("C", 1000) ); # Frequenz OSD Datensatz, * 10ms
$MkSendQueue->enqueue( "d", "$AddrNC", pack ("C", 1000) ); # Frequenz MK Debug Datensatz, * 10ms
usleep (200000);
$MkSendQueue->enqueue( "o", "$AddrNC", pack ("C", 1000) ); # Frequenz OSD Datensatz, * 10ms
$MkSendQueue->enqueue( "d", "$AddrNC", pack ("C", 1000) ); # Frequenz MK Debug Datensatz, * 10ms
usleep (200000);
# Alte WP-Liste im MK löschen
my $Wp = $Waypoints[0];
&MkFlyTo ( '-lat' => $Wp->{'Pos_Lat'},
'-lon' => $Wp->{'Pos_Lon'},
'-mode' => "Waypoint Delete"
);
for $i (0 .. $#Waypoints)
{
my $Wp = $Waypoints[$i];
&MkFlyTo ( '-lat' => $Wp->{'Pos_Lat'},
'-lon' => $Wp->{'Pos_Lon'},
'-alt' => $Wp->{'Pos_Alt'},
'-heading' => $Wp->{'Heading'},
'-toleranceradius' => $Wp->{'ToleranceRadius'},
'-holdtime' => $Wp->{'Holdtime'},
'-eventflag' => $Wp->{'Event_Flag'},
'-mode' => "Waypoint",
'-index' => $i,
);
usleep (150000) # NC Zeit zum Verarbeiten geben
}
$MkSendWp = 0; # normale OSD/Debug Abfragefrequenz wird automatisch im 5s Timer wieder eingestellt
# grey connectors: Wp are sent to MK
$map_canvas->itemconfigure('Waypoint-Connector',
'-fill' => $Cfg->{'mkcockpit'}->{'ColorWpConnector'},
);
# MK ist nun synchron mit @Waypoints
$WaypointsModified = 0;
}
# Redraw Waypoint Icons
sub WpRedrawIcons()
{
if ( $PlayerWptKmlMode =~ /WPT/i )
{
# delete old icons and Wp-Number from canvas
$map_canvas->delete('Waypoint');
$map_canvas->delete('WaypointNumber');
# create new icons
for $i (0 .. $#Waypoints)
{
my $Wp = $Waypoints[$i];
my $x = $Wp->{'MapX'};
my $y = $Wp->{'MapY'};
my $Tag = $Wp->{'Tag'};
# Waypoint Icon
my $IconHeight = 48;
my $IconWidth = 24;
$map_canvas->createImage($x-$IconWidth/2, $y-$IconHeight,
'-tags' => ['Waypoint', $Tag],
'-anchor' => 'nw',
'-image' => 'Waypoint-Photo',
);
# Waypoint Number
my $WpNumber = $i + 1;
$map_canvas->createText ( $x+3, $y-$IconHeight/2+12,
'-tags' => ['WaypointNumber', $Tag],
'-text' => $WpNumber,
'-font' => '-*-Arial-Bold-R-Normal--*-100-*',
'-fill' => $Cfg->{'mkcockpit'}->{'ColorWpNumber'},
'-anchor' => 'w',
);
}
$map_canvas->lower('Waypoint', 'Target'); # waypoint below Target
$map_canvas->lower('WaypointNumber', 'Waypoint'); # waypoint-number below waypoint
}
}
# Redraw Waypoint connectors
sub WpRedrawLines()
{
if ( $PlayerWptKmlMode eq 'WPT' and $PlayerRandomMode eq 'STD' )
{
# delete old connectors from canvas
$map_canvas->delete('Waypoint-Connector');
my $Color = $Cfg->{'mkcockpit'}->{'ColorWpConnector'};
if ( $WaypointsModified )
{
$Color = $Cfg->{'mkcockpit'}->{'ColorWpResend'};
}
my $Wp = $Waypoints[0];
my $x_last = $Wp->{'MapX'};
my $y_last = $Wp->{'MapY'};
for $i (1 .. $#Waypoints)
{
my $Wp = $Waypoints[$i];
my $x = $Wp->{'MapX'};
my $y = $Wp->{'MapY'};
$map_canvas->createLine ( $x_last, $y_last, $x, $y,
'-tags' => 'Waypoint-Connector',
'-arrow' => 'last',
'-arrowshape' => [10, 10, 3 ],
'-fill' => $Color,
'-width' => 1,
);
$x_last = $x;
$y_last = $y;
}
$map_canvas->raise('Waypoint-Connector', 'Map'); # connector above map
}
}
# Hide Waypoints and connectors on Canvas
sub WpHide()
{
$map_canvas->delete('Waypoint');
$map_canvas->delete('WaypointNumber');
$map_canvas->delete('Waypoint-Connector');
}
# Hide Kml-Track on Canvas
sub KmlHide()
{
$map_canvas->delete('KML-Track');
}
# Load @KmlTargets from file
sub KmlLoadFile()
{
my ($File) = @_;
# XML in Hash-Ref lesen
my $Kml = XMLin($File);
# init state maschine
undef @KmlTargets;
$KmlPlayerIndex = 0;
my $Coordinates = $Kml->{Document}->{Placemark}->{LineString}->{coordinates};
foreach $Line (split "\n", $Coordinates)
{
chomp $Line;
$Line =~ s/\s//g; # remove white space
if ( $Line ne "" )
{
my ($Lon, $Lat, $Alt) = split ",", $Line;
$Lon = sprintf ("%f", $Lon);
$Lat = sprintf ("%f", $Lat);
$Alt = sprintf ("%f", $Alt);
push @KmlTargets, {'Lat' => $Lat,
'Lon' => $Lon,
'Alt' => $Alt,
};
}
}
}
# Redraw KML track
sub KmlRedraw()
{
# delete old Track from canvas
$map_canvas->delete('KML-Track');
my @Track;
foreach $Target ( @KmlTargets )
{
my $Lat = $Target->{'Lat'};
my $Lon = $Target->{'Lon'};
my $Alt = $Target->{'Alt'};
my ($x, $y) = &MapGps2XY($Lat, $Lon);
push @Track, $x, $y;
}
if ( scalar @Track >= 4 ) # at least 2 Koordinaten-Paare
{
$map_canvas->createLine ( @Track,
'-tags' => 'KML-Track',
'-fill' => $Cfg->{'mkcockpit'}->{'ColorKmlTrack'},
'-width' => 1,
);
$map_canvas->lower('KML-Track', 'Target'); # Track below Target
}
}
# Redraw Footprint
sub FootprintRedraw()
{
# delete old Footprint from canvas
$map_canvas->delete('Footprint');
if ( scalar @Footprint >= 4 ) # at least 2 Koordinaten-Paare
{
$map_canvas->createLine ( @Footprint,
'-tags' => 'Footprint',
'-fill' => $Cfg->{'mkcockpit'}->{'ColorFootprint'},
'-width' => 1,
);
}
$map_canvas->lower('Footprint', 'Target');
}
# Waypoint Player: Set Waypoint - sequence or random
sub WpTargetSet()
{
my ($Index) = @_;
my $WpCnt = scalar @Waypoints;
if ( $Index < 0 or $Index >= $WpCnt )
{
# invalid WP number
return 1;
}
my $Wp = $Waypoints[$Index];
my $Wp_x = $Wp->{'MapX'};
my $Wp_y = $Wp->{'MapY'};
# is Wp reachable?
if ( ! &IsTargetReachable($Wp_x, $Wp_y) )
{
# new Wp-Target is not reachable
return 1;
}
# set new Wp-Target
$WpPlayerIndex = $Index;
$WpPlayerHoldtime = -1;
return 0;
}
# Waypoint Player: Goto next Waypoint - sequence or random
sub WpTargetNext()
{
my $WpCnt = scalar @Waypoints;
# Std- or Random Waypoint sequence
if ( $PlayerRandomMode =~ /STD/i or
$PlayerRandomMode =~ /RND/i )
{
$NewIndex = $WpPlayerIndex;
# get next Wp
for ( $i=0; $i<5; $i++) # avoid deadlock, if no WP reachable
{
for ( $j=0; $j<5; $j++ ) # avoid deadlock, if only 1 WP
{
if ( $PlayerRandomMode =~ /STD/i )
{
$NewIndex ++;
if ( $NewIndex >= $WpCnt )
{
# Restart with 1st Wp
$NewIndex = 0;
}
}
if ( $PlayerRandomMode =~ /RND/i )
{
$NewIndex = int (rand($WpCnt));
}
# want to have different Wp
if ( $NewIndex ne $WpPlayerIndex )
{
last;
}
}
# Set new Target
if ( &WpTargetSet ($NewIndex) == 0 )
{
# new Wp-Target set
last;
}
}
}
# Random Map sequence
if ( $PlayerRandomMode =~ /MAP/i )
{
$RandomTarget_x = $MkPos_x;
$RandomTarget_y = $MkPos_y;
for ( $i=0; $i<50; $i++) # avoid deadlock, if target not reachable
{
# don't use 10% around the map
my $New_x = int (rand($MapSizeX - 2 * $MapSizeX/10));
my $New_y = int (rand($MapSizeY - 2 * $MapSizeY/10));
$New_x += $MapSizeX/10;
$New_y += $MapSizeY/10;
# is Target reachable?
if ( &IsTargetReachable($New_x, $New_y) )
{
# new Target found
$RandomTarget_x = $New_x;
$RandomTarget_y = $New_y;
last;
}
}
}
&TtsSpeak ('MEDIUM', $Translate{'TtsNextTarget'});
$WpPlayerHoldtime = -1;
}
# Waypoint Player: Goto previous Waypoint
sub WpTargetPrev()
{
if ( $PlayerRandomMode =~ /STD/i )
{
$WpPlayerIndex --;
if ( $WpPlayerIndex < 0 )
{
# Restart with last Wp
$WpPlayerIndex = $#Waypoints;
}
}
else
{
# Next Random Target
&WpTargetNext();
}
$WpPlayerHoldtime = -1;
}
# Waypoint Player: Goto first Waypoint
sub WpTargetFirst()
{
$WpPlayerIndex = 0;
$WpPlayerHoldtime = -1;
}
# Waypoint Player: Goto last Waypoint
sub WpTargetLast()
{
$WpPlayerIndex = $#Waypoints;
$WpPlayerHoldtime = -1;
}
# Waypoint Player: Waypoint Target reached?
sub WpCheckTargetReached()
{
if ( $WpPlayerHoldtime == -1 )
{
lock (%MkOsd); # until end of block
if ( &CurPosIsValid() and &HomePosIsValid() and &MkIsWptMode() )
{
# Gueltige SAT Daten
# for Wp mode
my $Wp = $Waypoints[$WpPlayerIndex];
my $WpTarget_Lat = $Wp->{'Pos_Lat'};
my $WpTarget_Lon = $Wp->{'Pos_Lon'};
my $WpTolerance = $Wp->{'ToleranceRadius'};
my $WpHoldtime = $Wp->{'Holdtime'};
# Random-Map Mode
if ( $PlayerRandomMode =~ /MAP/i )
{
($WpTarget_Lat, $WpTarget_Lon) = &MapXY2Gps ($RandomTarget_x, $RandomTarget_y);
$WpTolerance = $Cfg->{'waypoint'}->{'DefaultToleranceRadius'};
$WpHoldtime = $Cfg->{'waypoint'}->{'DefaultHoldtime'};
}
# Operation Radius pruefen
my ($HomeDist, $HomeBearing) = &MapGpsTo($MkOsd{'HomePos_Lat'}, $MkOsd{'HomePos_Lon'}, $WpTarget_Lat, $WpTarget_Lon );
if ( $HomeDist > $MkOsd{'OperatingRadius'} )
{
# Target entsprechend Operation Radius neu berechnen
$HomeDist = $MkOsd{'OperatingRadius'};
($WpTarget_Lat, $WpTarget_Lon) = &MapGpsAt($MkOsd{'HomePos_Lat'}, $MkOsd{'HomePos_Lon'}, $HomeDist, $HomeBearing);
}
# Abstand zum Ziel pruefen
my ($Dist, $Bearing) = &MapGpsTo($MkOsd{'CurPos_Lat'}, $MkOsd{'CurPos_Lon'}, $WpTarget_Lat, $WpTarget_Lon );
$Dist = int ($Dist + 0.5);
if ( $Dist <= $WpTolerance )
{
# Target reached - count down Holdtime
$WpPlayerHoldtime = 2 * $WpHoldtime; # 0..2n - decrement im 0.5s timer
&TtsSpeak ('MEDIUM', $Translate{'TtsTargetReached'});
}
}
}
if ( $WpPlayerHoldtime == 0 ) # wird im 0.5s timer runtergezaehlt
{
# Target reached - Holdtime is over
$WpPlayerHoldtime = -1;
return 1;
}
# Target NOT reached
return 0;
}
# KML Player: 10s forward
sub KmlTargetNext()
{
$KmlPlayerIndex += int (10 / $Cfg->{waypoint}->{'KmlTimeBase'} + 0.5);
if ( $KmlPlayerIndex > $#KmlTargets )
{
# Next loop
$KmlPlayerIndex -= $#KmlTargets;
}
}
# KML Player: 10s backward
sub KmlTargetPrev()
{
$KmlPlayerIndex -= int (10 / $Cfg->{waypoint}->{'KmlTimeBase'} + 0.5);
if ( $KmlPlayerIndex < 0 )
{
# Next loop
$KmlPlayerIndex += $#KmlTargets;
}
}
# KML Player: Goto first Target
sub KmlTargetFirst()
{
$KmlPlayerIndex = 0;
}
# KML Player: Goto last Target
sub KmlTargetLast()
{
$KmlPlayerIndex = $#KmlTargets;
}
#
# Set Player modes
#
# set Player mode
sub PlayerModeSet()
{
my ($Mode) = @_;
if ( $Mode =~ /play/i ) { &PlayerPlay(); }
elsif ( $Mode =~ /pause/i ) { &PlayerPause(); }
elsif ( $Mode =~ /home/i ) { &PlayerHome(); }
elsif ( $Mode =~ /stop/i ) { &PlayerStop(); }
}
# set player to "Play" mode
sub PlayerPlay()
{
$PlayerMode = 'Play';
$WpPlayerHoldtime = -1;
# Play/Pause-Icon loeschen und neu anzeigen
$map_canvas->delete('Wp-PlayPause');
$map_canvas->createImage($MapSizeX/2+150, $MapSizeY-48,
'-tags' => 'Wp-PlayPause',
'-anchor' => 'nw',
'-image' => 'WpPause-Foto',
);
&FoxHide();
&CrosshairHide();
}
# set player to "Pause" mode
sub PlayerPause()
{
$PlayerMode = 'Pause';
$WpPlayerHoldtime = -1;
# Play/Pause-Icon loeschen und neu anzeigen
$map_canvas->delete('Wp-PlayPause');
$map_canvas->createImage($MapSizeX/2+150, $MapSizeY-48,
'-tags' => 'Wp-PlayPause',
'-anchor' => 'nw',
'-image' => 'WpPlay-Foto',
);
# momentane Position merken und im Player-Timer senden
$PlayerPause_Lon = "";
$PlayerPause_Lat = "";
lock (%MkOsd); # until end of block
if ( &CurPosIsValid() )
{
$PlayerPause_Lon = $MkOsd{'CurPos_Lon'};
$PlayerPause_Lat = $MkOsd{'CurPos_Lat'};
}
&FoxShow();
# restart crosshair timer
$CrosshairTimerCnt = 0;
}
# set player to "Home" mode
sub PlayerHome()
{
$PlayerMode = 'Home';
&WpTargetFirst();
# Play/Pause-Icon loeschen und neu anzeigen
$map_canvas->delete('Wp-PlayPause');
$map_canvas->createImage($MapSizeX/2+150, $MapSizeY-48,
'-tags' => 'Wp-PlayPause',
'-anchor' => 'nw',
'-image' => 'WpPlay-Foto',
);
&FoxHide();
&CrosshairHide();
}
# set player to "Stop" mode
sub PlayerStop()
{
$PlayerMode = 'Stop';
&WpTargetFirst();
# set Play/Pause Icon to "Play
$map_canvas->delete('Wp-PlayPause');
$map_canvas->createImage($MapSizeX/2+150, $MapSizeY-48,
'-tags' => 'Wp-PlayPause',
'-anchor' => 'nw',
'-image' => 'WpPlay-Foto',
);
# switch player to Wp Mode
&PlayerWpt();
&FoxHide();
&CrosshairHide();
}
# set player Random Mode to "STD"
sub PlayerRandomStd()
{
$PlayerRandomMode = "STD";
# Set Icon
$map_canvas->delete('Wp-WptRandom');
$map_canvas->createImage($MapSizeX/2-200, $MapSizeY-48,
'-tags' => 'Wp-WptRandom',
'-anchor' => 'nw',
'-image' => 'WpRandomOn-Foto',
);
# redraw connectors and Icons on canvas
&WpRedrawLines();
&WpRedrawIcons();
}
# set player Random Mode to "RND"
sub PlayerRandomRnd()
{
$PlayerRandomMode = "RND";
# Set Icon
$map_canvas->delete('Wp-WptRandom');
$map_canvas->createImage($MapSizeX/2-200, $MapSizeY-48,
'-tags' => 'Wp-WptRandom',
'-anchor' => 'nw',
'-image' => 'WpRandomMap-Foto',
);
# delete Wp-connectors from canvas
$map_canvas->delete('Waypoint-Connector');
}
# set player Random Mode to "MAP"
sub PlayerRandomMap()
{
$PlayerRandomMode = "MAP";
# Set Icon
$map_canvas->delete('Wp-WptRandom');
$map_canvas->createImage($MapSizeX/2-200, $MapSizeY-48,
'-tags' => 'Wp-WptRandom',
'-anchor' => 'nw',
'-image' => 'WpRandomOff-Foto',
);
# Get 1st Target
&WpTargetNext();
# hide WP and connectors on canvas
&WpHide();
}
# set player Pause Mode to "MAP", "MK"
sub PlayerPauseMode()
{
($PlayerPauseMode) = @_;
}
# set player to KML mode
sub PlayerKml()
{
$PlayerWptKmlMode = 'KML';
# Wpt/Kml-Player-Icon loeschen und neu anzeigen
$map_canvas->delete('Wp-WptKml');
$map_canvas->createImage($MapSizeX/2-250, $MapSizeY-48,
'-tags' => 'Wp-WptKml',
'-anchor' => 'nw',
'-image' => 'WpKml-Foto',
);
# delete Waypoints from canvas
&WpHide();
# show KML Track
&KmlRedraw();
}
# set player to WPT mode
sub PlayerWpt()
{
$PlayerWptKmlMode = 'WPT';
# Wpt/Kml-Player-Icon loeschen und neu anzeigen
$map_canvas->delete('Wp-WptKml');
$map_canvas->createImage($MapSizeX/2-250, $MapSizeY-48,
'-tags' => 'Wp-WptKml',
'-anchor' => 'nw',
'-image' => 'WpWpt-Foto',
);
# delete Kml-Track from canvas
&KmlHide();
# Show waypoints, WP resend required
$WaypointsModified = 1;
if ( $PlayerRandomMode ne 'MAP' )
{
&WpRedrawIcons()
}
if ( $PlayerRandomMode eq 'STD' )
{
&WpRedrawLines()
}
}
# Activate Recording mode
sub PlayerRecordOn
{
$PlayerRecordMode = "REC";
$map_canvas->itemconfigure ('MK-OSD-Rec-Value', '-text' => "Recording" );
# Record new KML-Track
undef @KmlTargets;
$KmlPlayerIndex = 0;
# delete Kml-Track from canvas
&KmlHide();
}
# Deactivate Recording mode
sub PlayerRecordOff
{
$PlayerRecordMode = "";
$map_canvas->itemconfigure ('MK-OSD-Rec-Value', '-text' => "" );
}
# Hide Fox icon on canvas
sub FoxHide()
{
$map_canvas->lower('Fox', 'Map');
}
# Show Fox icon on canvas
sub FoxShow()
{
$map_canvas->raise('Fox', 'Target');
}
# Hide POI icon on canvas
sub PoiHide()
{
$map_canvas->lower('POI', 'Map');
}
# Show POI icon on canvas
sub PoiShow()
{
$map_canvas->raise('POI', 'Track-Antenna');
}
# Show Grid on canvas
sub GridShow()
{
my $Dist = $Cfg->{map}->{'GridDist'} || 50;
my $Color = $Cfg->{map}->{'GridColor'} || "#909090";
my $xmin = 0;
my $ymin = 0;
my $xmax = $MapSizeX;
my $ymax = $MapSizeY;
+
+ my $PhiRef = &MapAngel();
+ my ($Lat1, $Lon1) = &MapXY2Gps($xmin, $ymin);
+ my ($Lat2, $Lon2) = &MapGpsAt($Lat1, $Lon1, $Dist, $PhiRef);
+ my ($x, $y) = &MapGps2XY($Lat2, $Lon2);
+ my $dpix = int ($x - $xmin + 0.5);
+
+ lock (%MkOsd); # until end of block
+ my $x0 = $MapSizeX / 2;
+ my $y0 = $MapSizeY / 2;
+ if ( &HomePosIsValid() )
+ {
+ ($x0, $y0) = &MapGps2XY ($MkOsd{'HomePos_Lat'}, $MkOsd{'HomePos_Lon'});
+ }
+
+ for ($x = $xmin + $x0 % $dpix; $x < $xmax; $x +=$dpix)
+ {
+ $map_canvas->createLine ( $x, $ymin, $x, $ymax,
+ '-tags' => 'Map-Grid',
+ '-arrow' => 'none',
+ '-fill' => $Color,
+ '-width' => 1,
+ );
+ }
+
+ for ($y = $ymin + $y0 % $dpix; $y < $ymax; $y +=$dpix)
+ {
+ $map_canvas->createLine ( $xmin, $y, $xmax, $y,
+ '-tags' => 'Map-Grid',
+ '-arrow' => 'none',
+ '-fill' => $Color,
+ '-width' => 1,
+ );
+ }
+
+ # Beschriftung x
+ for ( $x = xmin + $x0 % $dpix; $x < $xmax; $x += $dpix)
+ {
+ my $ScaleX = int (($x - $x0) / $dpix * $Dist + 0.5);
+ if ( $ScaleX < 0 )
+ {
+ $ScaleX = int (($x - $x0) / $dpix * $Dist - 0.5);
+ }
+ $map_canvas->createText ( $x - 2, $y0 - 8,
+ '-tags' => 'Map-Grid',
+ '-text' => sprintf ("%d", $ScaleX),
+ '-font' => '-*-Arial-Bold-R-Normal--*-150-*',
+ '-fill' => $Color,
+ '-anchor' => 'e',
+ );
+ }
+ # Beschriftung y
+ for ( $y = ymin + $y0 % $dpix; $y < $ymax; $y += $dpix)
+ {
+ my $ScaleY = int (($y - $y0) / $dpix * $Dist + 0.5);
+ if ( $ScaleY < 0 )
+ {
+ $ScaleY = int (($y - $y0) / $dpix * $Dist - 0.5);
+ }
+ $map_canvas->createText ( $x0 + 4, $y - 8,
+ '-tags' => 'Map-Grid',
+ '-text' => sprintf ("%d", $ScaleY * -1),
+ '-font' => '-*-Arial-Bold-R-Normal--*-150-*',
+ '-fill' => $Color,
+ '-anchor' => 'w',
+ );
+ }
+
+ $map_canvas->raise('Map-Grid', 'Map');
+ }
+
+
+# Hide Grid on canvas
+sub GridHide()
+ {
+ $map_canvas->delete('Map-Grid');
+ }
+
+
+# Show Crosshair for Pause Position on canvas
+sub CrosshairShow()
+ {
+ my ($Lat, $Lon) = @_;
+
+ my ($x, $y) = &MapGps2XY ($Lat, $Lon);
+ if ( $x != $LastCrosshairX and $y != $LastCroshairY )
+ {
+ # Only update, if coords changed - CPU consuming!
+ $map_canvas->coords ('Map-Crosshair-X', 0, $y, $MapSizeX, $y);
+ $map_canvas->coords ('Map-Crosshair-Y', $x, 0, $x, $MapSizeY);
+
+ $map_canvas->raise('Map-Crosshair', 'Target');
+ }
+
+ $LastCrosshairX = $x;
+ $LastCrosshairY = $y;
+ }
+
+
+# Hide Crosshair on canvas
+sub CrosshairHide()
+ {
+ $map_canvas->lower('Map-Crosshair', 'Map'); # hide below map
+
+ $LastCrosshairX = -1;
+ $LastCrosshairY = -1;
+ }
+
+
+#
+# System Messages
+#
+
+# Init Messages for a Subsystem/timer
+sub MkMessageInit ()
+ {
+ my ($Id) = @_;
+
+ $MkMessages{$Id} = [];
+ }
+
+
+# Register message
+sub MkMessage ()
+ {
+ my ($Message, $Id) = @_;
+
+ push @{$MkMessages{$Id}}, $Message;
+ }
+
+
+# show registered messages
+sub MkMessageShow()
+ {
+ my @Messages;
+ my $MsgLines = 0;
+ my $MaxMsgLen = 0;
+
+ # Collect Messages of each category
+ foreach my $Id (keys %MkMessages)
+ {
+ foreach $i ( 0 .. $#{$MkMessages{$Id}} )
+ {
+ my $Msg = $MkMessages{$Id}[$i];
+ push @Messages, $Msg;
+
+ $MsgLines ++;
+
+ my $Len = length $Msg;
+ if ( $Len > $MaxMsgLen )
+ {
+ $MaxMsgLen = $Len;
+ }
+ }
+ }
+
+ $map_canvas->delete('Message-Balloon'); # delete old Balloon
+
+ if ( $MsgLines > 0 )
+ {
+ # draw Balloon
+ my @MsgBalloon = ( $MkPos_x , $MkPos_y,
+ $MkPos_x + 30 , $MkPos_y + 40,
+ $MkPos_x + 30 + $MaxMsgLen * 11, $MkPos_y + 40,
+ $MkPos_x + 30 + $MaxMsgLen * 11, $MkPos_y + 44 + $MsgLines * 20,
+ $MkPos_x + 20, $MkPos_y + 44 + $MsgLines * 20,
+ $MkPos_x + 20, $MkPos_y + 40,
+ $MkPos_x, $MkPos_y,
+ );
+
+ $map_canvas->createPolygon( @MsgBalloon,
+ '-tags' => ['Message-Balloon', 'Message-BalloonBubble'],
+ '-fill' => 'yellow',
+ '-outline' => 'yellow',
+ '-width' => 1,
+ );
+ # draw Messages
+ my $MsgLine = 1;
+ foreach my $Msg (@Messages)
+ {
+ $map_canvas->createText ( $MkPos_x + 25, $MkPos_y + 32 + $MsgLine * 20 ,
+ '-tags' => ['Message-Balloon', 'Message-BalloonText'],
+ '-text' => $Msg,
+ '-font' => '-*-Arial-Bold-R-Normal--*-200-*',
+ '-fill' => 'blue',
+ '-anchor' => 'w',
+ );
+ $MsgLine ++;
+ }
+
+
+ $map_canvas->lower('Message-Balloon', 'MK-Arrow');
+ }
+
+ }
+
+
+# Show Balloon, when arproaching Target
+sub TargetMessageShow ()
+ {
+ $map_canvas->delete('Target-Balloon'); # delete old Balloon
+
+ if ( $OperationMode ne "Free" and $MkOsd{'TargetPos_Stat'} == 1 and $MkOsd{'TargetPosDev_Dist'} /10 < 25 )
+ {
+ my $BalloonLines = 0;
+ $ColorBalloon = "blue";
+ my ($T_x, $T_y) = &MapGps2XY($MkOsd{'TargetPos_Lat'}, $MkOsd{'TargetPos_Lon'});
+ my $Wp = $Waypoints[$MkOsd{'WaypointIndex'}];
+
+ # Holdtime Wp-Player Mode
+ if ( $WpPlayerHoldtime >= 0 and $PlayerWptKmlMode eq "WPT" )
+ {
+ # Holdtime
+ $ColorBalloon = 'red';
+ my $HoldTime = sprintf ("%5s %3d s", "HLD:", int ($WpPlayerHoldtime / 2 + 0.5) );
+ $map_canvas->createText ( $T_x + 25, $T_y - 40,
+ '-tags' => ['Target-Balloon', 'Target-BalloonText'],
+ '-text' => $HoldTime,
+ '-font' => '-*-Arial-Bold-R-Normal--*-200-*',
+ '-fill' => $ColorBalloon,
+ '-anchor' => 'w',
+ );
+ $BalloonLines ++;
+ }
+
+ # Holdtime WPT-Mode
+ if ( &MkTargetReached() and $OperationMode eq "WPT" )
+ {
+ # Holdtime from MK
+ $ColorBalloon = 'red';
+ my $HoldTime = sprintf ("%5s %3d s", "HLD:", int ($MkOsd{'TargetHoldTime'} + 0.5) );
+ $map_canvas->createText ( $T_x + 25, $T_y - 40,
+ '-tags' => ['Target-Balloon', 'Target-BalloonText'],
+ '-text' => $HoldTime,
+ '-font' => '-*-Arial-Bold-R-Normal--*-200-*',
+ '-fill' => $ColorBalloon,
+ '-anchor' => 'w',
+ );
+ $BalloonLines ++;
+ }
+
+ # Tolerance Radius Player Mode
+ if ( &MkIsWptMode() and $OperationMode eq "Play" and $PlayerWptKmlMode eq "WPT" )
+ {
+ my $WpTolerance = sprintf ("%5s %3d m", "TOL:", $Wp->{'ToleranceRadius'});
+ $map_canvas->createText ( $T_x + 25, $T_y - 60,
+ '-tags' => ['Target-Balloon', 'Target-BalloonText'],
+ '-text' => $WpTolerance,
+ '-font' => '-*-Arial-Bold-R-Normal--*-200-*',
+ '-fill' => $ColorBalloon,
+ '-anchor' => 'w',
+ );
+ $BalloonLines ++;
+ }
+
+ # Tolerance WPT-Mode
+ if ( &MkIsWptMode and $OperationMode eq "WPT" )
+ {
+ my $WpTolerance = sprintf ("%5s %3d m", "TOL:", $Wp->{'ToleranceRadius'} );
+ $map_canvas->createText ( $T_x + 25, $T_y - 60,
+ '-tags' => ['Target-Balloon', 'Target-BalloonText'],
+ '-text' => $WpTolerance,
+ '-font' => '-*-Arial-Bold-R-Normal--*-200-*',
+ '-fill' => $ColorBalloon,
+ '-anchor' => 'w',
+ );
+ $BalloonLines ++;
+ }
+
+ # Distance to Target
+ my $Dist = int ($MkOsd{'TargetPosDev_Dist'} /10 + 0.5);
+ $map_canvas->createText ( $T_x + 25, $T_y - 80,
+ '-tags' => ['Target-Balloon', 'Target-BalloonText'],
+ '-text' => sprintf ("%5s %3d m", "DST:", $Dist) ,
+ '-font' => '-*-Arial-Bold-R-Normal--*-200-*',
+ '-fill' => $ColorBalloon,
+ '-anchor' => 'w',
+ );
+ $BalloonLines ++;
+
+ if ( $BalloonLines >= 1 )
+ {
+ # draw Balloon
+ my @TargetBalloon = ( $T_x , $T_y,
+ $T_x + 30, $T_y - (3 - $BalloonLines) * 20 -27,
+ $T_x + 150, $T_y - (3 - $BalloonLines) * 20 -27 ,
+ $T_x + 150, $T_y - 93,
+ $T_x + 20, $T_y - 93,
+ $T_x + 20, $T_y - (3 - $BalloonLines) * 20 -27,
+ $T_x, $T_y,
+ );
+
+ $map_canvas->createPolygon( @TargetBalloon,
+ '-tags' => ['Target-Balloon', 'Target-BalloonBubble'],
+ '-fill' => 'lightgray',
+ '-outline' => 'yellow',
+ '-width' => 1,
+ );
+ }
+
+
+ $map_canvas->lower('Target-Balloon', 'MK-Home-Line');
+ $map_canvas->lower('Target-BalloonBubble', 'Target-BalloonText');
+ }
+ }
+
+
+#
+# Airfield border
+#
+
+# Are two segments A(a1/a2), B(b1/b2) and C(c1/c2), D(d1/d2) crossing ?
+sub SegmentCross()
+ {
+ my ( $a1, $a2, $b1, $b2, $c1, $c2, $d1, $d2) = @_;
+
+ # segment C/D ist vertical, avoid div/0
+ if ( $c1 == $d1 )
+ {
+ $d1 += 0.00001;
+ }
+
+ my $n = ($b1 - $a1) * ($d2 - $c2) - ($b2 - $a2) * ($d1 - $c1);
+ if ( $n == 0.0 )
+ {
+ # AB und CD sind parallel
+ return 0;
+ }
+
+ my $s = ( ($c1 - $a1) * ($d2 - $c2) - ($c2 - $a2) * ($d1 - $c1) ) / $n;
+ my $t = ( $a1 - $c1 + $s * ($b1 - $a1) ) / ( $d1 - $c1 );
+ if ( $s >= 0.0 and $s <= 1.0 and $t >= 0.0 and $t <= 1.0 )
+ {
+ # beide Strecken kreuzen sich
+
+ # Schnittpunkt: s_x, s_y
+ my $s_x = $a1 + $s * ( $b1 - $a1 );
+ my $s_y = $a2 + $s * ( $b2 - $a2 );
+
+ return 1;
+ }
+
+ # beide Strecken kreuzen sich nicht
+ return 0;
+ }
+
+
+# How often does a segment A(a1,a2), B(b1,b2) cross the polygon?
+sub SegmentPolygonCross()
+ {
+ my ( $a1, $a2, $b1, $b2, $Polygon) = @_;
+
+ my $Cross = 0;
+ my $PolyCnt = scalar @{$Polygon};
+ my $PolyPointCnt = $PolyCnt / 2;
+
+ my $i = 0;
+ for ( $p=0; $p < $PolyPointCnt; $p++ )
+ {
+ my $c1 = ${$Polygon}[$i++];
+ my $c2 = ${$Polygon}[$i++];
+
+ if ( $i >= $PolyCnt ) { $i = 0; }
+
+ my $d1 = ${$Polygon}[$i];
+ my $d2 = ${$Polygon}[$i+1];
+
+ # map calibration offsets
+ $c1 -= $Map{'Offset_x'};
+ $c2 += $Map{'Offset_y'};
+ $d1 -= $Map{'Offset_x'};
+ $d2 += $Map{'Offset_y'};
+
+ if ( &SegmentCross($a1, $a2, $b1, $b2, $c1, $c2, $d1, $d2) )
+ {
+ $Cross ++;
+ }
+ }
+
+ return $Cross;
+ }
+
+
+# Is point A inside airfield border?
+sub IsInsideBorder()
+ {
+ my ($a1, $a2) = @_;
+
+ if ( scalar @Map{'Border'} == 0 )
+ {
+ # no border defined, always inside
+ return 1;
+ }
+
+ my $Cross = &SegmentPolygonCross (-10, -10, $a1, $a2, @Map{'Border'} );
+
+ # Ungerade Anzahl Kreuzungen: Inside
+ return ( $Cross % 2 );
+ }
+
+
+
+# Is segment A, B crossing the airfield border?
+sub IsCrossingBorder()
+ {
+ my ($a1, $a2, $b1, $b2) = @_;
+
+ if ( scalar @Map{'Border'} == 0 )
+ {
+ # no border defined, always not crossing
+ return 0;
+ }
+
+ my $Cross = &SegmentPolygonCross ($a1, $a2, $b1, $b2, @Map{'Border'} );
+
+ return ( $Cross > 0 );
+ }
+
+
+# How often is segment A, B crossing the airfield border?
+sub CrossingBorderCount()
+ {
+ my ($a1, $a2, $b1, $b2) = @_;
+
+ if ( scalar @Map{'Border'} == 0 )
+ {
+ # no border defined, not crossing
+ return 0;
+ }
+
+ my $Cross = &SegmentPolygonCross ($a1, $a2, $b1, $b2, @Map{'Border'} );
+
+ return ( $Cross );
+ }
+
+
+# check, if Target is reachable my MK
+sub IsTargetReachable()
+ {
+ my ($T_x, $T_y) = @_;
+
+ my $MkIsInside = &IsInsideBorder($MkPos_x, $MkPos_y);
+ my $TargetIsInside = &IsInsideBorder($T_x, $T_y);
+ my $MkTargetCrossingCount = &CrossingBorderCount($MkPos_x, $MkPos_y, $T_x, $T_y);
+
+ if ( ($MkIsInside and $MkTargetCrossingCount == 0 ) or
+ (! $MkIsInside and $TargetIsInside and $MkTargetCrossingCount == 1) )
+ {
+ # Target is reachable
+ return 1;
+ }
+
+ # Target is not reachable
+ return 0;
+ }
+
+
+#
+# Configuration and data-visualisation
+#
+
+# Display or Modify Hash
+sub DisplayHash()
+ {
+ my ($hrefData, $Titel, $Mode) = @_;
+
+ # $Mode: Display, Edit, Waypoint, Refresh, Heartbeat, SerialChannel, ExternControl
+
+ my $MaxRow = 20; # number or Rows in multi column view
+ my %Id;
+ my $Label;
+ my $Value;
+
+ # Neues Fenster aufmachen
+ my $popup = $main->Toplevel();
+ $popup->title($Titel);
+
+ # Frame mit den Buttons
+ my $popup_button = $popup->Frame() -> pack('-side' => 'bottom',
+ '-expand' => 'y',
+ '-anchor' => 's',
+ '-padx' => 5,
+ '-pady' => 5,
+ );
+ $popup_button->Button('-text' => 'Schließen',
+ '-command' => sub
+ {
+ if ( $Mode =~ /edit/i and $Mode =~ /waypoint/i )
+ {
+ $WaypointsModified = 1;
+ &WpRedrawLines();
+ &WpRedrawIcons();
+ }
+
+ $popup->destroy()
+ })->pack;
+
+ # Frame mit den Labels und Daten
+ my $popup_data = $popup->Frame() -> pack('-side' => 'left',
+ '-expand' => 'y',
+ '-anchor' => 'w',
+ '-padx' => 10,
+ '-pady' => 10,
+ );
+ # Labels und Daten anzeigen
+ my $Row = 0;
+ my $Col = 0;
+
+ foreach $Label ( sort keys %{$hrefData})
+ {
+ $LabelView = $Label;
+ if ( $Translate{$LabelView} ne "" )
+ {
+ $LabelView = $Translate{$LabelView};
+ }
+
+ # Label
+ $popup_data->Label ('-text' => $LabelView,
+ '-width' => 25,
+ '-anchor' => 'w',
+ ) -> grid( -row => $Row,
+ -column => $Col,
+ -padx => 10,
+ );
+ # Daten
+ if ( $Mode =~ /display/i )
+ {
+ # Display
+ if ( ref ${$hrefData}{$Label} )
+ {
+ $Text = "- can't display references -";
+ }
+ else
+ {
+ $Text = ${$hrefData}{$Label};
+ }
+
+ $Id{$Label} = $popup_data->Label ('-text' => $Text,
+ '-width' => 20,
+ '-anchor' => 'e',
+ '-relief' => 'sunken',
+ ) -> grid( -row => $Row,
+ -column => $Col + 1,
+ -padx => 10,
+ );
+ }
+ if ( $Mode =~ /edit/i )
+ {
+ # Edit
+ $Id{$Label} = $popup_data->Entry ('-textvariable' => \${$hrefData}{$Label},
+ '-exportselection' => '1',
+ '-width' => 20,
+ '-relief' => 'sunken',
+ ) -> grid( -row => $Row,
+ -column => $Col + 1,
+ -padx => 10,
+ );
+ if ( $Mode =~ /waypoint/i )
+ {
+ # einige Waypoint-Felder nicht aenderbar einstellen
+ if ( "MapX MapY Pos_Lat Pos_Lon Tag" =~ /$Label/i )
+ {
+ $Id{$Label}->configure('-state' => 'disabled', );
+ }
+ }
+ }
+
+ # multi Column wrap
+ $Row++;
+ if ( $Row > $MaxRow )
+ {
+ $Row = 0;
+ $Col += 2;
+ }
+ }
+
+
+ if ( $Mode =~ /refresh/i )
+ {
+ # Timer: 0.1s
+ $popup_data->repeat (100, sub
+ {
+ # Datenfelder alle 100ms aktualisieren
+
+ my $BgColor = 'white';
+ if ( $Mode =~ /heartbeat/i )
+ {
+ $BgColor = 'red';
+ if ( &MkOsdIsValid() )
+ {
+ # gültige daten vom MK
+ $BgColor = 'white';
+ }
+ }
+
+ if ( $Mode =~ /serialchannel/i )
+ {
+ $BgColor = 'red';
+ if ( $Cfg->{'serialchannel'}->{'SerialChannelSend'} =~ /y/i )
+ {
+ # senden aktiv
+ $BgColor = 'white';
+ }
+ }
+
+ if ( $Mode =~ /externcontrol/i )
+ {
+ $BgColor = 'red';
+ if ( $Cfg->{'externcontrol'}->{'ExternControlSend'} =~ /y/i )
+ {
+ # senden aktiv
+ $BgColor = 'white';
+ }
+ }
+
+ foreach $Label ( sort keys %{$hrefData} )
+ {
+ # Eingebbare Waypoint-Felder nicht aktualisieren
+ if ( ! ($Mode =~ /waypoint/i and
+ "Event_Flag Heading ToleranceRadius HoldTime Pos_Alt" =~ /$Label/i) )
+ {
+ $Id{$Label}->configure('-text' => ${$hrefData}{$Label},
+ '-background' => "$BgColor",
+ );
+ }
+ }
+ });
+ }
+
+ return 0;
+ }
+
+
+# Konfigurations-Hash (aus XML-Datei) im Popup-Fenster editieren
+sub Configure()
+ {
+ my ($CfgFile, $hrefCfg, $Mode) = @_;
+
+ # get a copy of Cfg-Hash for editing
+ my $CfgEdit = &CopyHash($hrefCfg);
+
+ # Neues Fenster aufmachen
+ my $popup = $main->Toplevel();
+ $popup->title("Einstellungen - $CfgFile");
+
+ # Display data in a notebook widget
+ my $book = $popup->NoteBook()->grid(-row => 0,
+ -column => 0,
+ -columnspan => 4,
+ -sticky => 'w',
+ -padx => 5,
+ -pady => 5,
+ );
+ # Show data
+ &ConfigureShow($book, $CfgEdit);
+
+ # Button: OK
+ $popup->Button('-text' => 'OK',
+ '-width' => '10',
+ '-command' => sub
+ {
+ # Save and activate config
+ &ConfigureSave( $CfgFile, $hrefCfg, $CfgEdit);
+
+ $popup->destroy();
+
+ } )->grid(-row => 1,
+ -column => 0,
+ -sticky => 'w',
+ -padx => 15,
+ -pady => 5,
+ );
+
+ # Button: Apply
+ $popup->Button('-text' => $Translate{'Apply'},
+ '-width' => '10',
+ '-command' => sub
+ {
+ # Save and activate config
+ &ConfigureSave( $CfgFile, $hrefCfg, $CfgEdit);
+
+ } )->grid(-row => 1,
+ -column => 1,
+ -sticky => 'w',
+ -padx => 15,
+ -pady => 5,
+ );
+
+
+ # Button: Abort
+ $popup->Button('-text' => $Translate{'Abort'},
+ '-width' => '10',
+ '-command' => sub { $popup->destroy() },
+ )->grid(-row => 1,
+ -column => 2,
+ -sticky => 'w',
+ -padx => 15,
+ -pady => 5,
+ );
+
+ #
+ # special handling for "Config" configuration
+ #
+ if ( $Mode =~ /CONFIG/i )
+ {
+ $popup->Label ('-text' => $Translate{'RestartRequired'},
+ '-anchor' => 'w',
+ '-foreground' => 'red',
+ )->grid(-row => 1,
+ -column => 3,
+ -sticky => 'w',
+ -padx => 5,
+ -pady => 5,
+ );
+ }
+
+
+ #
+ # special handling for "Event" configuration
+ #
+ if ( $Mode =~ /EVENT/i )
+ {
+
+ # notebook must have at least one tab
+ if (scalar $book->pages() == 0 )
+ {
+ # create new record in hash
+ my $NewEvent = sprintf ("Event%d", scalar $book->pages() + 1);
+ &EventInit($NewEvent, $CfgEdit);
+
+ # Display new event
+ &ConfigureShow($book, $CfgEdit);
+ $book->raise($NewEvent);
+ }
+
+
+ # Menu bar (New, Delete, Rename)
+
+ my $menu_bar = $popup->Menu;
+ $popup->optionAdd("*tearOff", "false");
+ $popup->configure ('-menu' => $menu_bar);
+
+ my $menu_event = $menu_bar->cascade('-label' => $Translate{'Event'});
+
+ #
+ # New Event
+ #
+ $menu_event->command('-label' => $Translate{'EventNew'},
+ '-command' => sub
+ {
+ # Event Name in neuem Fenster abfragen
+ my $popup_new = $popup->Toplevel();
+ $popup_new->title("Event - $Translate{'EventNew'}");
+
+ $popup_new->Label (-text => $Translate{'EventNewName'},
+ -width => 20,
+ -anchor => 'w',
+ )->grid (-row => 0,
+ -column => 0,
+ -sticky => 'w',
+ -padx => 5,
+ -pady => 5,
+ );
+
+ my $NewEvent = sprintf ("Event%d", scalar $book->pages() + 1);
+ $popup_new->Entry ( -textvariable => \$NewEvent,
+ -exportselection => '1',
+ -width => 40,
+ -relief => 'sunken',
+ )->grid (-row => 0,
+ -column => 1,
+ -sticky => 'w',
+ -padx => 5,
+ -pady => 5,
+ );
+ # Button: OK
+ $popup_new->Button('-text' => "OK",
+ '-width' => '10',
+ '-command' => sub
+ {
+ # create new record in hash
+ $NewEvent = &EventnameAdjust($NewEvent);
+ &EventInit($NewEvent, $CfgEdit);
+
+ # Display new event
+ &ConfigureShow($book, $CfgEdit);
+ $book->raise($NewEvent);
+
+ $popup_new->destroy();
+ } )->grid (-row => 1,
+ -column => 0,
+ -sticky => 'w',
+ -padx => 20,
+ -pady => 5,
+ );
+
+ # Button: Abort
+ $popup_new->Button('-text' => $Translate{'Abort'},
+ '-width' => '10',
+ '-command' => sub
+ {
+ $popup_new->destroy()
+ } )->grid (-row => 1,
+ -column => 1,
+ -sticky => 'e',
+ -padx => 20,
+ -pady => 5,
+ );
+ });
+
+ #
+ # Rename Event
+ #
+ $menu_event->command('-label' => $Translate{'EventRename'},
+ '-command' => sub
+ {
+ # Event Name in neuem Fenster abfragen
+ my $popup_rename = $popup->Toplevel();
+ $popup_rename->title("Event - $Translate{'EventRename'}");
+
+ $popup_rename->Label (-text => $Translate{'EventName'},
+ -width => 20,
+ -anchor => 'w',
+ )->grid (-row => 0,
+ -column => 0,
+ -sticky => 'e',
+ -padx => 5,
+ -pady => 5,
+ );
+
+ my $CurrentEvent = $book->raised;
+ $popup_rename->Entry ( -textvariable => \$CurrentEvent,
+ -exportselection => '1',
+ -width => 40,
+ -relief => 'sunken',
+ -state => 'disabled',
+ )->grid (-row => 0,
+ -column => 1,
+ -sticky => 'w',
+ -padx => 5,
+ -pady => 5,
+ );
+
+ $popup_rename->Label (-text => $Translate{'EventNewName'},
+ -width => 20,
+ -anchor => 'w',
+ )->grid (-row => 1,
+ -column => 0,
+ -sticky => 'e',
+ -padx => 5,
+ -pady => 5,
+ );
+
+ my $NewEvent = sprintf ("Event%d", scalar $book->pages() + 1);
+ $popup_rename->Entry ( -textvariable => \$NewEvent,
+ -exportselection => '1',
+ -width => 40,
+ -relief => 'sunken',
+ )->grid (-row => 1,
+ -column => 1,
+ -sticky => 'w',
+ -padx => 5,
+ -pady => 5,
+ );
+
+ # Button: OK
+ $popup_rename->Button('-text' => "OK",
+ '-width' => '10',
+ '-command' => sub
+ {
+ $NewEvent = &EventnameAdjust($NewEvent);
+
+ # create new record in hash
+ $CfgEdit->{$NewEvent} = $CfgEdit->{$CurrentEvent};
+ delete $CfgEdit->{$CurrentEvent}
+
+ # Display events again
+ &ConfigureShow($book, $CfgEdit);
+
+ $book->raise($NewEvent);
+
+ $popup_rename->destroy();
+ } )->grid (-row => 2,
+ -column => 0,
+ -sticky => 'e',
+ -padx => 20,
+ -pady => 5,
+ );
+
+ # Button: Abort
+ $popup_rename->Button('-text' => $Translate{'Abort'},
+ '-width' => '10',
+ '-command' => sub
+ {
+ $popup_rename->destroy()
+ } )->grid (-row => 2,
+ -column => 1,
+ -sticky => 'w',
+ -padx => 20,
+ -pady => 5,
+ );
+
+ });
+
+ #
+ # Copy Event
+ #
+ $menu_event->command('-label' => $Translate{'EventCopy'},
+ '-command' => sub
+ {
+ # Event Name in neuem Fenster abfragen
+ my $popup_copy = $popup->Toplevel();
+ $popup_copy->title("Event - $Translate{'EventCopy'}");
+
+ my $CurrentEvent = $book->raised;
+ my $CopyEvent = sprintf ("Event%d", scalar $book->pages() + 1);
+
+ $popup_copy->Label (-text => $Translate{'EventName'},
+ -width => 20,
+ -anchor => 'w',
+ )->grid (-row => 0,
+ -column => 0,
+ -sticky => 'e',
+ -padx => 5,
+ -pady => 5,
+ );
+
+ $popup_copy->Entry ( -textvariable => \$CurrentEvent,
+ -exportselection => '1',
+ -width => 40,
+ -relief => 'sunken',
+ -state => 'disabled',
+ )->grid (-row => 0,
+ -column => 1,
+ -sticky => 'w',
+ -padx => 5,
+ -pady => 5,
+ );
+
+ $popup_copy->Label (-text => $Translate{'EventNewName'},
+ -width => 20,
+ -anchor => 'w',
+ )->grid (-row => 1,
+ -column => 0,
+ -sticky => 'w',
+ -padx => 5,
+ -pady => 5,
+ );
+
+
+ $popup_copy->Entry ( -textvariable => \$CopyEvent,
+ -exportselection => '1',
+ -width => 40,
+ -relief => 'sunken',
+ )->grid (-row => 1,
+ -column => 1,
+ -sticky => 'w',
+ -padx => 5,
+ -pady => 5,
+ );
+ # Button: OK
+ $popup_copy->Button('-text' => "OK",
+ '-width' => '10',
+ '-command' => sub
+ {
+ $CopyEvent = &EventnameAdjust($CopyEvent);
+
+ # copy hash
+ $CfgEdit->{$CopyEvent} = {%{$hrefCfg->{$CurrentEvent}}};
+
+ # Display new event
+ &ConfigureShow($book, $CfgEdit);
+ $book->raise($CopyEvent);
+
+ $popup_copy->destroy();
+ } )->grid (-row => 2,
+ -column => 0,
+ -sticky => 'w',
+ -padx => 20,
+ -pady => 5,
+ );
+
+ # Button: Abort
+ $popup_copy->Button('-text' => $Translate{'Abort'},
+ '-width' => '10',
+ '-command' => sub
+ {
+ $popup_copy->destroy()
+ } )->grid (-row => 2,
+ -column => 1,
+ -sticky => 'e',
+ -padx => 20,
+ -pady => 5,
+ );
+ });
+
+ #
+ # Delete event
+ #
+ $menu_event->command('-label' => $Translate{'EventDelete'},
+ '-command' => sub
+ {
+ my $CurrentBook = $book->raised;
+
+ # delet event in Cfg-Hash
+ delete $CfgEdit->{$CurrentBook};
+
+ # Display events again
+ &ConfigureShow($book, $CfgEdit);
+ });
+
+ #
+ # Export current Event
+ #
+ $menu_event->command('-label' => $Translate{'EventExport'},
+ '-command' => sub
+ {
+ my $XmlFile = $popup->getSaveFile('-defaultextension' => ".xml",
+ '-filetypes' =>
+ [['Event', '.xml' ],
+ ['All Files', '*', ],
+ ],
+ '-initialdir' => "event",
+ '-title' => $Translate{'EventExport'},
+ );
+ if ( $XmlFile ne "" )
+ {
+ my %ExportCfg;
+ my $CurrentEvent = $book->raised;
+
+ # copy and quote event
+ foreach $key (keys %{$CfgEdit->{$CurrentEvent}})
+ {
+ my $Line = $CfgEdit->{$CurrentEvent}->{$key};
+ $ExportCfg->{$key} = &QuoteXML($Line);
+ }
+
+ # Event in XML-Datei speichern
+ &XMLout ($ExportCfg, # save quoted hash
+ 'OutputFile' => $XmlFile,
+ 'AttrIndent' => '1',
+ 'RootName' => 'mkcockpit-Event',
+ 'NoEscape' => '1',
+ );
+ }
+
+ });
+
+ #
+ # Import XML to current Event
+ #
+ $menu_event->command('-label' => $Translate{'EventImport'},
+ '-command' => sub
+ {
+ my $XmlFile = $popup->getOpenFile(-defaultextension => ".xml",
+ -filetypes =>
+ [['Event', '.xml' ],
+ ['All Files', '*', ],
+ ],
+ -initialdir => "event",
+ -title => $Translate{'EventImport'},
+ );
+ if ( -f $XmlFile )
+ {
+ my $CurrentEvent = $book->raised;
+ my $ImportCfg = XMLin($XmlFile);
+
+ # copy event
+ foreach $key (keys %{$ImportCfg})
+ {
+ $CfgEdit->{$CurrentEvent}->{$key} = $ImportCfg->{$key};
+ }
+
+ # deactivate Event
+ $CfgEdit->{$CurrentEvent}->{'Active'} = "NO";
+ }
+ });
+ }
+ }
+
+
+# Copy a Cfg-Hash including real copy of hash-references
+sub CopyHash()
+ {
+ my ($hrefCfg) = @_;
+
+ my $CfgCopy = {%{$hrefCfg}};
+ foreach $key (keys %{$hrefCfg})
+ {
+ if ( ref $hrefCfg->{$key} )
+ {
+ $CfgCopy->{$key} = {%{$hrefCfg->{$key}}};
+ }
+ }
+ return $CfgCopy;
+ }
+
+
+# Initialize a new event
+sub EventInit()
+ {
+ my ($EventName, $Cfg) = @_;
+
+ $Cfg->{$EventName}->{'Active'} = "no";
+ $Cfg->{$EventName}->{'Action'} = "";
+ $Cfg->{$EventName}->{'ActionElse'} = "";
+ $Cfg->{$EventName}->{'Condition'} = "";
+ $Cfg->{$EventName}->{'Delay'} = "";
+ $Cfg->{$EventName}->{'Repeat'} = "";
+ $Cfg->{$EventName}->{'RepeatElse'} = "";
+ $Cfg->{$EventName}->{'Description'} = "";
+ $Cfg->{$EventName}->{'Trigger'} = "TRUE";
+ }
+
+
+# Event-Name XML konform anpassen
+sub EventnameAdjust()
+ {
+ my ($Name) = @_;
+
+ $Name =~ s/\W/_/g;
+ if ( substr ($Name, 0, 1) =~ /\d/ )
+ {
+ substr ($Name, 0, 1) = "_";
+ }
+
+ return $Name;
+ }
+
+
+# Reiter mit Konfigurationsdaten anzeigen
+sub ConfigureShow()
+ {
+ my ($book, $CfgEdit) = @_;
+
+ # delete all existing tabs in notebook
+ foreach my $Tab ($book->pages)
+ {
+ $book->delete($Tab);
+ }
+
+ # jede Sektion in eigenem Tab anzeigen
+ foreach $key (sort keys %{$CfgEdit})
+ {
+ if ( ! ref $CfgEdit->{$key} )
+ {
+ next;
+ }
+
+ my $TabLabel = "$key";
+ if ( $Translate{$key} ne "" )
+ {
+ $TabLabel = $Translate{$key};
+ }
+
+ my $Tab = $book->add( "$key",
+ -label => "$TabLabel",
+ -wraplength => "75",
+ );
+
+ # Frame for label and data
+ my $popup_cfg = $Tab->Frame() -> pack('-anchor' => 'w',
+ '-padx' => 5,
+ '-pady' => 5,
+ );
+
+ # Eingabefelder/Optionmenu/Fileselection mit Daten anzeigen
+ $Row = 0;
+ foreach $Entry ( sort keys %{$CfgEdit->{$key}})
+ {
+ # Label
+ my $Label = $Entry;
+ if ( $Translate{$Label} ne "" )
+ {
+ $Label = $Translate{$Label};
+ }
+
+ $popup_cfg->Label (-text => $Label,
+ -width => 35,
+ -anchor => 'w',
+ )->grid (-row => $Row,
+ -column => 0,
+ );
+ #
+ # Combo Box with optiones defined in libcfgopt.pl
+ #
+ if ( defined $CfgOpt{$Entry}[0] )
+ {
+ my $cbo = $popup_cfg->BrowseEntry( -label => "",
+ -variable => \$CfgEdit->{$key}->{$Entry},
+ -width => 37,
+ -relief => 'sunken'
+ )->grid (-row => $Row,
+ -column => 1,
+ -columnspan => 2,
+ -sticky => 'w',
+ );
+ # add options
+ $cbo->insert("end", @{ $CfgOpt{$Entry} });
+ }
+
+ #
+ # File selection, if defined in libcfgopt.pl
+ #
+ elsif ( defined $CfgFile{$Entry} )
+ {
+ # a) Text entry
+ my $TextEntry = $popup_cfg->Entry ( -textvariable => \$CfgEdit->{$key}->{$Entry},
+ -exportselection => '1',
+ -width => 37,
+ -relief => 'sunken',
+ )->grid (-row => $Row,
+ -column => 1,
+ -columnspan => 1,
+ -sticky => 'e',
+ );
+ # b) button with file selection dialog
+ my $Mode = $CfgFile{$Entry};
+ $popup_cfg->Button('-text' => '>',
+ '-width' => 1,
+ '-command' => sub
+ {
+ my $File = $popup_cfg->getOpenFile( '-title' => $Label );
+ if ($File ne "" )
+ {
+ if ( $Mode =~ /Filename/i )
+ {
+ $File = substr ($File, rindex ($File, '/') +1 );
+ }
+ elsif ( $Mode =~ /Path/i )
+ {
+ # nothing to do
+ }
+
+ # show selection in text entry
+ $TextEntry->delete (0, length $TextEntry->get );
+ $TextEntry->insert (0, $File);
+ }
+ } )->grid (-row => $Row,
+ -column => 2,
+ -sticky => 'e',
+ );
+ }
+
+ #
+ # Multiline Text widget, if defined in libcfgopt.pl
+ #
+ elsif ( defined $CfgText{$Entry} )
+ {
+ # a) Text entry
+
+ my $State = 'normal';
+ my $NumLines = grep /\n/, $CfgEdit->{$key}->{$Entry};
+ if ( $NumLines > 0 )
+ {
+ $State = 'disabled';
+ }
+ my $TextEntry = $popup_cfg->Entry ( -textvariable => \$CfgEdit->{$key}->{$Entry},
+ -exportselection => '1',
+ -state => $State,
+ -width => 37,
+ -relief => 'sunken',
+ )->grid (-row => $Row,
+ -column => 1,
+ -columnspan => 1,
+ -sticky => 'e',
+ );
+
+ # b) button with multiline Text-Edit dialog
+ my ($Width, $Height) = split /;/, $CfgText{$Entry};
+ my $Title = "Edit: $key -> $Entry";
+ my $refVariable = \$CfgEdit->{$key}->{$Entry};
+
+ $popup_cfg->Button('-text' => '>',
+ '-width' => 1,
+ '-command' => sub
+ {
+ # popup mit Text-Widget
+
+ my $popup_text = $popup_cfg->Toplevel();
+ $popup_text->title($Title);
+
+ my $text = $popup_text->Scrolled( "Text",
+ -height => $Height,
+ -width => $Width,
+ -wrap => 'none',
+ )->pack();
+
+ $text->insert('end', $$refVariable);
+
+ # OK Button
+ $popup_text->Button('-text' => 'OK',
+ '-width' => 10,
+ '-command' => sub
+ {
+ # Text uebernehmen
+ $$refVariable = $text->get("1.0", "end");
+ chomp $$refVariable;
+
+ $popup_text->destroy()
+
+ } )->pack ('-side' => 'left',
+ '-expand' => 'y',
+ '-anchor' => 's',
+ '-padx' => 5,
+ '-pady' => 5,
+ );
+
+ # Anwenden Button
+ $popup_text->Button('-text' => $Translate{'Apply'},
+ '-width' => 10,
+ '-command' => sub
+ {
+ # Text uebernehmen
+ $$refVariable = $text->get("1.0", "end");
+ chomp $$refVariable;
+
+ } )->pack ('-side' => 'left',
+ '-expand' => 'y',
+ '-anchor' => 's',
+ '-padx' => 5,
+ '-pady' => 5,
+ );
+
+ # Abort Button
+ $popup_text->Button('-text' => $Translate{'Abort'},
+ '-width' => '10',
+ '-command' => sub
+ {
+ $popup_text->destroy();
+
+ } )->pack ('-side' => 'left',
+ '-expand' => 'y',
+ '-anchor' => 's',
+ '-padx' => 5,
+ '-pady' => 5,
+ );
+ } )->grid (-row => $Row,
+ -column => 2,
+ -sticky => 'e',
+ );
+ }
+
+ #
+ # Text entry
+ #
+ else
+ {
+ $popup_cfg->Entry ( -textvariable => \$CfgEdit->{$key}->{$Entry},
+ -exportselection => '1',
+ -width => 40,
+ -relief => 'sunken',
+ )->grid (-row => $Row,
+ -column => 1,
+ -columnspan => 2,
+ -sticky => 'e',
+ );
+ }
+
+ # next Variable in next row
+ $Row ++;
+ }
+ }
+ }
+
+
+# Quote for output to XML-file
+sub QuoteXML()
+ {
+ my ($Line) = @_;
+
+ $Line =~ s/\&/\&amp;/g;
+ $Line =~ s/'/\&apos;/g;
+ $Line =~ s/</\&lt;/g;
+ $Line =~ s/>/\&gt;/g;
+ $Line =~ s/"/\&quot;/g;
+ $Line =~ s/\n/\&#10;/g;
+
+ return $Line;
+ }
+
+
+# Activate and save Config to file
+sub ConfigureSave()
+ {
+ my ($CfgFile, $hrefCfg, $CfgEdit) = @_;
+
+ # set new timestamp
+ my ($sec,$min,$hour,$mday,$mon,$year,$wday,$yday,$isdst) = localtime(time);
+ my $TimeStamp = sprintf ("%04d%02d%02d-%02d%02d%02d", $year+1900, $mon+1, $mday, $hour, $min, $sec);
+ $CfgEdit->{'CreationDate'} = $TimeStamp;
+
+ # set MkCockpit Version
+ $CfgEdit->{'Version'} = $Version{'mkcockpit.pl'};
+
+ # empty original hash
+ foreach $key (keys %{$hrefCfg})
+ {
+ delete $hrefCfg->{$key};
+ }
+
+ # Build %CfgXml with XML-quoting
+ my $CfgXml = {};
+
+ # then copy %CfgEdit back to $hrefCfg.
+ foreach $key (keys %{$CfgEdit})
+ {
+ if ( ref $CfgEdit->{$key} )
+ {
+ # Reference
+ foreach $val (keys %{$CfgEdit->{$key}})
+ {
+ my $Line = $CfgEdit->{$key}->{$val};
+ $hrefCfg->{$key}->{$val} = $Line;
+ $CfgXml->{$key}->{$val} = &QuoteXML($Line);
+ }
+ }
+ else
+ {
+ # Scalar
+ my $Line = $CfgEdit->{$key};
+ $hrefCfg->{$key} = $Line;
+ $CfgXml->{$key} = &QuoteXML($Line);
+ }
+ }
+
+ # Cfg in XML-Datei speichern
+ &XMLout ($CfgXml, # save quoted hash
+ 'OutputFile' => $CfgFile,
+ 'AttrIndent' => '1',
+ 'RootName' => 'mkcockpit-Config',
+ 'NoEscape' => '1',
+ );
+ }
+
+1;
+
+__END__

/MissionCockpit/tags/V0.4.0/libmksim.pl
0,0 → 1,1129
#!/usr/bin/perl
#!/usr/bin/perl -d:ptkdb
###############################################################################
#
# libmap.pl - Conversion GPS and Map-X/Y Coordinates
#
# Copyright (C) 2009 Rainer Walther (rainerwalther-mail@web.de)
#
# Creative Commons Lizenz mit den Zusaetzen (by, nc, sa)
#
# Es ist Ihnen gestattet:
# * das Werk vervielfältigen, verbreiten und öffentlich zugänglich machen
# * Abwandlungen bzw. Bearbeitungen des Inhaltes anfertigen
#
# Zu den folgenden Bedingungen:
# * Namensnennung.
# Sie müssen den Namen des Autors/Rechteinhabers in der von ihm festgelegten Weise nennen.
# * Keine kommerzielle Nutzung.
# Dieses Werk darf nicht für kommerzielle Zwecke verwendet werden.
# * Weitergabe unter gleichen Bedingungen.
# Wenn Sie den lizenzierten Inhalt bearbeiten oder in anderer Weise umgestalten,
# verändern oder als Grundlage für einen anderen Inhalt verwenden,
# dürfen Sie den neu entstandenen Inhalt nur unter Verwendung von Lizenzbedingungen
# weitergeben, die mit denen dieses Lizenzvertrages identisch oder vergleichbar sind.
#
# Im Falle einer Verbreitung müssen Sie anderen die Lizenzbedingungen, unter welche dieses
# Werk fällt, mitteilen. Am Einfachsten ist es, einen Link auf diese Seite einzubinden.
#
# Jede der vorgenannten Bedingungen kann aufgehoben werden, sofern Sie die Einwilligung
# des Rechteinhabers dazu erhalten.
#
# Diese Lizenz lässt die Urheberpersönlichkeitsrechte unberührt.
#
# Weitere Details zur Lizenzbestimmung gibt es hier:
# Kurzform: http://creativecommons.org/licenses/by-nc-sa/3.0/de/
# Komplett: http://creativecommons.org/licenses/by-nc-sa/3.0/de/legalcode
#
###############################################################################
#
# 2009-10-10 0.0.1 rw created
# 2009-12-05 0.0.2 rw check, if no WP is defined
# 2010-01-27 0.0.3 rw UsedCapacity, Current
# switch of logging while sim is active
#
###############################################################################
$Version{'libmksim.pl'} = "0.0.3 - 2010-01-27";
my $Simulator = "OFF";
sub MkSim()
{
# switch off logging
$LogQueue->enqueue( "OFF" );
my $popup = $main->Toplevel();
$popup->title("MikroKopter Simulator");
# Catch delete window event and exit sim
$popup->protocol( 'WM_DELETE_WINDOW' => sub
{
&CbSimStop();
$popup->destroy();
});
my $menu_bar = $popup->Menu;
$popup->optionAdd("*tearOff", "false");
$popup->configure ('-menu' => $menu_bar);
my $menu_action = $menu_bar->cascade('-label' => "Action");
$menu_action->command('-label' => "3D Fix",
'-command' => [\&CbSim3DFix ],
);
$menu_action->command('-label' => "Make MK Fly",
'-command' => [\&CbSimMkFly ],
);
$menu_action->separator;
$menu_action->command('-label' => "Start Simulator",
'-command' => [\&CbSimStart ],
);
$menu_action->command('-label' => "Stop Simulator",
'-command' => [\&CbSimStop ],
);
my $frame = $popup->Frame() -> pack('-side' => 'top',
'-expand' => 'y',
'-anchor' => 's',
'-padx' => 5,
'-pady' => 5,
);
my $button = $popup->Frame() -> pack('-side' => 'bottom',
'-expand' => 'y',
'-anchor' => 's',
'-padx' => 5,
'-pady' => 5,
);
# Exit Button
$button->Button('-text' => 'Exit',
'-width' => 10,
'-command' => sub
{
&CbSimStop();
$popup->destroy();
}) -> pack( '-anchor' => 's',
'-padx' => 5,
'-pady' => 5,
);
# Tabs erstellen
my $book = $frame->NoteBook()->pack( -fill=>'both', -expand=>1 );
#
# Tab: GPS
#
my $GpsTab = $book->add( "GPS", -label=>"GPS" );
# canvas grid position
my $GpsRow = 0;
my $GpsCol = 0;
my $GpsRowMap = $GpsRow + 1;
my $GpsColMap = $GpsCol;
my $GpsRowAlt = $GpsRow + 2;
my $GpsColAlt = $GpsCol;
my $GpsRowStat = $GpsRow + 4;
my $GpsColStat = $GpsCol;
my $GpsRowSats = $GpsRow + 5;
my $GpsColSats = $GpsCol;
# Create and scale Photo
my $ImgWidth = "$Cfg->{'map'}->{'SimImageSize'}" || 300;
my $Factor = $MapSizeX / $ImgWidth;
my $Img1 = $popup->Photo( 'SimFoto',
'-file' => "$Cfg->{'map'}->{'MapDir'}/$Map{'File'}",
);
my $Img2 = $popup->Photo ('SimFoto-Resized');
$Img2->copy ( $Img1,
'-shrink',
'-subsample' => $Factor, $Factor,
);
my $ImgWidth = $Img2->width;
my $ImgHeight = $Img2->height;
my $ImgScaleX = $MapSizeX / $ImgWidth;
my $ImgScaleY = $MapSizeY / $ImgHeight;
# display scaled Photo on canvas
my $canvas = $GpsTab->Canvas( '-width' => $ImgWidth,
'-height' => $ImgHeight,
) -> grid (-row => $GpsRowMap,
-column => $GpsColMap,
-columnspan => 4,
);
$canvas->createImage( 0, 0,
'-tags' => 'SimMap',
'-anchor' => 'nw',
'-image' => $Img2,
);
# Circle-Icon for MK, Target, Home
my $Dia = 14;
my $ImgSplit = $ImgWidth / 4;
my $MkX = $ImgSplit - $Dia/2;
my $MkY = $ImgHeight / 2 + $Dia/2;
my $TargetX = $ImgSplit * 2 - $Dia/2;
my $TargetY = $ImgHeight / 2 + $Dia/2;
my $HomeX = $ImgSplit * 3 - $Dia/2;
my $HomeY = $ImgHeight / 2 + $Dia/2;
($MkOsd{'CurPos_Lat'}, $MkOsd{'CurPos_Lon'}) = &MapXY2Gps ($MkX * $ImgScaleX, $MkY * $ImgScaleY);
($MkOsd{'TargetPos_Lat'}, $MkOsd{'TargetPos_Lon'}) = &MapXY2Gps ($TargetX * $ImgScaleX, $TargetY * $ImgScaleY);
($MkOsd{'HomePos_Lat'}, $MkOsd{'HomePos_Lon'}) = &MapXY2Gps ($HomeX * $ImgScaleX, $HomeY * $ImgScaleY);
$canvas->createOval ( $HomeX, $HomeY, $HomeX + $Dia, $HomeY + $Dia,
'-tags' => "SimHome",
'-fill' => $Cfg->{'mkcockpit'}->{'ColorHomeLine'},
'-outline' => "white",
);
$canvas->createOval ( $TargetX, $TargetY, $TargetX + $Dia, $TargetY + $Dia,
'-tags' => "SimTarget",
'-fill' => $Cfg->{'mkcockpit'}->{'ColorTargetLine'},
'-outline' => "white",
);
$canvas->createOval ( $MkX, $MkY, $MkX + $Dia, $MkY + $Dia,
'-tags' => "SimMk",
'-fill' => $Cfg->{'mkcockpit'}->{'ColorMkSatGood'},
'-outline' => "white",
);
# GPS Alt MK
$GpsTab->Label(-text => , $Translate{'CurPos_Alt'},
)->grid ('-row' => $GpsRowAlt,
'-column' => $GpsColAlt,
'-sticky' => 'w',
);
$MkOsd{'CurPos_Alt'} = 0;
$scCurPos_Alt = $GpsTab->Scale(
'-orient' => 'vertical',
'-from' => 400,
'-to' => 0,
'-tickinterval' => 50,
'-resolution' => 1,
'-label' => "",
'-font' => '-adobe-helvetica-medium-r-normal--10-100-75-75-p-56-iso8859-1',
'-length' => 150,
'-width' => 15,
'-variable' => \$MkOsd{'CurPos_Alt'},
)->grid ('-row' => $GpsRowAlt+1,
'-column' => $GpsColAlt,
);
$MkOsd{'CurPos_Stat'} = 0;
$cbCurPos_Stat = $GpsTab->Checkbutton(
-text => $Translate{'CurPos_Stat'},
-offvalue => 0x00,
-onvalue => 0x01,
-variable => \$MkOsd{'CurPos_Stat'},
)->grid (-row => $GpsRowStat,
-column => $GpsColStat,
-columnspan => 2,
-sticky => 'w',
);
# Altimeter
$GpsTab->Label(-text => , $Translate{'Altimeter'},
)->grid ('-row' => $GpsRowAlt,
'-column' => $GpsColAlt +1,
);
$MkOsd{'Altimeter'} = 0;
$scAltimeter = $GpsTab->Scale(
-orient => 'vertical',
-from => 8000,
-to => 0,
-tickinterval => 2000,
-resolution => 1,
-label => "",
-font => '-adobe-helvetica-medium-r-normal--10-100-75-75-p-56-iso8859-1',
-length => 150,
-width => 15,
-variable => \$MkOsd{'Altimeter'},
)->grid (-row => $GpsRowAlt +1,
-column => $GpsColAlt +1,
);
# GPS Alt Target
$GpsTab->Label(-text => , $Translate{'TargetPos_Alt'},
)->grid ('-row' => $GpsRowAlt,
'-column' => $GpsColAlt +2,
);
$MkOsd{'TargetPos_Alt'} = 0;
$scTargetPos_Alt = $GpsTab->Scale(
'-orient' => 'vertical',
'-from' => 400,
'-to' => 0,
'-tickinterval' => 50,
'-resolution' => 1,
'-label' => "",
'-font' => '-adobe-helvetica-medium-r-normal--10-100-75-75-p-56-iso8859-1',
'-length' => 150,
'-width' => 15,
'-variable' => \$MkOsd{'TargetPos_Alt'},
)->grid ('-row' => $GpsRowAlt +1,
'-column' => $GpsColAlt +2,
);
$MkOsd{'TargetPos_Stat'} = 0;
$cbTargetPos_Stat = $GpsTab->Checkbutton(-text => $Translate{'TargetPos_Stat'},
-offvalue => 0x00,
-onvalue => 0x01,
-variable => \$MkOsd{'TargetPos_Stat'},
)->grid (-row => $GpsRowStat,
-column => $GpsColStat +2,
);
# GPS Alt Home
$GpsTab->Label(-text => , $Translate{'HomePos_Alt'},
)->grid ('-row' => $GpsRowAlt,
'-column' => $GpsColAlt +3,
);
$MkOsd{'HomePos_Alt'} = 0;
$scHomePos_Alt = $GpsTab->Scale(
'-orient' => 'vertical',
'-from' => 400,
'-to' => 0,
'-tickinterval' => 50,
'-resolution' => 1,
'-label' => "",
'-font' => '-adobe-helvetica-medium-r-normal--10-100-75-75-p-56-iso8859-1',
'-length' => 150,
'-width' => 15,
'-variable' => \$MkOsd{'HomePos_Alt'},
)->grid ('-row' => $GpsRowAlt +1,
'-column' => $GpsColAlt +3,
);
$MkOsd{'HomePos_Stat'} = 0;
$cbHomePos_Stat = $GpsTab->Checkbutton(
-text => "Home Status", # $Translate{'HomePos_Stat'},
-offvalue => 0x00,
-onvalue => 0x01,
-variable => \$MkOsd{'HomePos_Stat'},
)->grid (-row => $GpsRowStat,
-column => $GpsColStat +3,
);
# Sats in Use
$MkOsd{'SatsInUse'} = 0;
$scSatsInUse = $GpsTab->Scale(
'-orient' => 'horizontal',
'-from' => 0,
'-to' => 12,
'-resolution' => 1,
'-tickinterval' => 1,
'-label' => $Translate{'SatsInUse'},
'-font' => '-adobe-helvetica-medium-r-normal--10-100-75-75-p-56-iso8859-1',
'-length' => 300,
'-width' => 15,
'-variable' => \$MkOsd{'SatsInUse'},
)->grid (-row => $GpsRowSats,
-column => $GpsColSats,
-columnspan => 4,
);
# Balloon
my $simballoon = $popup->Balloon();
$simballoon->attach($canvas,
'-balloonposition' => 'mouse',
'-state' => 'balloon',
'-msg' => { 'SimMk' => 'MikroKopter',
'SimTarget' => 'Target',
'SimHome' => 'Home',
},
);
# Mouse button 1 for MK
my $MkOldx = 0;
my $MkOldy = 0;
# Pick MK
$canvas->bind('SimMk' => '<Button-1>' => sub
{
# prepare to move
my ($x, $y) = ($Tk::event->x, $Tk::event->y);
$MkOldx = $x;
$MkOldy = $y;
});
# Move Mk
$canvas->bind('SimMk' => '<Button1-Motion>' => sub
{
my ($x, $y) = ($Tk::event->x, $Tk::event->y);
my $id = $canvas->find('withtag', 'current');
my $Dia2 = $Dia/2;
if ( $x < $Dia2 ) { $x = $Dia2 };
if ( $y < $Dia2 ) { $y = $Dia2 };
if ( $x > $ImgWidth - $Dia2 ) { $x = $ImgWidth - $Dia2 };
if ( $y > $ImgHeight - $Dia2) { $y = $ImgHeight - $Dia2 };
$canvas->move($id => $x - $MkOldx, $y - $MkOldy);
$MkOldx = $x;
$MkOldy = $y;
($MkOsd{'CurPos_Lat'}, $MkOsd{'CurPos_Lon'}) = &MapXY2Gps ($x * $ImgScaleX, $y * $ImgScaleY);
});
# Mouse button 1 for Target
my $TargetOldx = 0;
my $TargetOldy = 0;
# Pick Target
$canvas->bind('SimTarget' => '<Button-1>' => sub
{
# prepare to move
my ($x, $y) = ($Tk::event->x, $Tk::event->y);
$TargetOldx = $x;
$TargetOldy = $y;
});
# Move Target
$canvas->bind('SimTarget' => '<Button1-Motion>' => sub
{
my ($x, $y) = ($Tk::event->x, $Tk::event->y);
my $id = $canvas->find('withtag', 'current');
my $Dia2 = $Dia/2;
if ( $x < $Dia2 ) { $x = $Dia2 };
if ( $y < $Dia2 ) { $y = $Dia2 };
if ( $x > $ImgWidth - $Dia2 ) { $x = $ImgWidth - $Dia2 };
if ( $y > $ImgHeight - $Dia2) { $y = $ImgHeight - $Dia2 };
$canvas->move($id => $x - $TargetOldx, $y - $TargetOldy);
$TargetOldx = $x;
$TargetOldy = $y;
($MkOsd{'TargetPos_Lat'}, $MkOsd{'TargetPos_Lon'}) = &MapXY2Gps ($x * $ImgScaleX, $y * $ImgScaleY);
});
# Mouse button 1 for Home
my $HomeOldx = 0;
my $HomeOldy = 0;
# Pick Home
$canvas->bind('SimHome' => '<Button-1>' => sub
{
# prepare to move
my ($x, $y) = ($Tk::event->x, $Tk::event->y);
$HomeOldx = $x;
$HomeOldy = $y;
});
# Move Home
$canvas->bind('SimHome' => '<Button1-Motion>' => sub
{
my ($x, $y) = ($Tk::event->x, $Tk::event->y);
my $id = $canvas->find('withtag', 'current');
my $Dia2 = $Dia/2;
if ( $x < $Dia2 ) { $x = $Dia2 };
if ( $y < $Dia2 ) { $y = $Dia2 };
if ( $x > $ImgWidth - $Dia2 ) { $x = $ImgWidth - $Dia2 };
if ( $y > $ImgHeight - $Dia2) { $y = $ImgHeight - $Dia2 };
$canvas->move($id => $x - $HomeOldx, $y - $HomeOldy);
$HomeOldx = $x;
$HomeOldy = $y;
($MkOsd{'HomePos_Lat'}, $MkOsd{'HomePos_Lon'}) = &MapXY2Gps ($x * $ImgScaleX, $y * $ImgScaleY);
});
#
# Tab: Navigation
#
my $NavTab = $book->add( "Navigation", -label=>"Navigation", );
my $Row = 0;
my $Col = 0;
# Waypoint Index
$MkOsd{'WaypointIndex'} = 0;
$scWaypointIndex = $NavTab->Scale(
-orient => 'horizontal',
-from => 0,
-to => 20,
-tickinterval => 5,
-resolution => 1,
-label => $Translate{'WaypointIndex'},
-font => '-adobe-helvetica-medium-r-normal--10-100-75-75-p-56-iso8859-1',
-length => 300,
-width => 15,
-variable => \$MkOsd{'WaypointIndex'},
)->grid (-row => $Row + 1,
-column => $Col,
);
# Waypoint Number
$MkOsd{'WaypointNumber'} = 0;
$scWaypointNumber = $NavTab->Scale(
-orient => 'horizontal',
-from => 0,
-to => 20,
-tickinterval => 5,
-resolution => 1,
-label => $Translate{'WaypointNumber'},
-font => '-adobe-helvetica-medium-r-normal--10-100-75-75-p-56-iso8859-1',
-length => 300,
-width => 15,
-variable => \$MkOsd{'WaypointNumber'},
)->grid (-row => $Row + 2,
-column => $Col,
);
# Operating Radius
$MkOsd{'OperatingRadius'} = 250;
$scOperatingRadius = $NavTab->Scale(
-orient => 'horizontal',
-from => 0,
-to => 250,
-tickinterval => 50,
-resolution => 1,
-label => "$Translate{'OperatingRadius'} (m)",
-font => '-adobe-helvetica-medium-r-normal--10-100-75-75-p-56-iso8859-1',
-length => 300,
-width => 15,
-variable => \$MkOsd{'OperatingRadius'},
)->grid (-row => $Row + 3,
-column => $Col,
);
# TargetPosDev_Dist
$MkOsd{'TargetPosDev_Dist'} = 250;
$scTargetPosDev_Dist = $NavTab->Scale(
-orient => 'horizontal',
-from => 0,
-to => 500,
-tickinterval => 100,
-resolution => 1,
-label => "$Translate{'TargetPosDev_Dist'} (dm)",
-font => '-adobe-helvetica-medium-r-normal--10-100-75-75-p-56-iso8859-1',
-length => 300,
-width => 15,
-variable => \$MkOsd{'TargetPosDev_Dist'},
)->grid (-row => $Row + 4,
-column => $Col,
);
#
# Tab: MK
#
my $MkTab = $book->add( "MikroKopter1", -label=>"MikroKopter 1", );
my $Row = 0;
my $Col = 0;
# Battery
$MkOsd{'UBat'} = 12.6;
$scUBat = $MkTab->Scale(
-orient => 'horizontal',
-from => 6.0,
-to => 18.0,
-tickinterval => 2,
-resolution => 0.1,
-label => "$Translate{'UBat'} (V)",
-font => '-adobe-helvetica-medium-r-normal--10-100-75-75-p-56-iso8859-1',
-length => 200,
-width => 15,
-variable => \$MkOsd{'UBat'},
)->grid (-row => $Row,
-column => $Col,
);
# RC Quality
$MkOsd{'RC_Quality'} = 190;
$scRC_Quality = $MkTab->Scale(
-orient => 'horizontal',
-from => 0,
-to => 200,
-tickinterval => 50,
-resolution => 1,
-label => $Translate{'RC_Quality'},
-font => '-adobe-helvetica-medium-r-normal--10-100-75-75-p-56-iso8859-1',
-length => 200,
-width => 15,
-variable => \$MkOsd{'RC_Quality'},
)->grid (-row => $Row +1,
-column => $Col,
);
# CompassHeading
$MkOsd{'CompassHeading'} = 0;
$scCompassHeading = $MkTab->Scale(
-orient => 'horizontal',
-from => 0,
-to => 360,
-tickinterval => 45,
-resolution => 1,
-label => $Translate{'CompassHeading'},
-font => '-adobe-helvetica-medium-r-normal--10-100-75-75-p-56-iso8859-1',
-length => 200,
-width => 15,
-variable => \$MkOsd{'CompassHeading'},
)->grid (-row => $Row +2,
-rowspan => 4,
-column => $Col,
);
# GPS Groundspeed
$MkOsd{'GroundSpeed'} = 0;
$scGroundSpeed = $MkTab->Scale(
-orient => 'horizontal',
-from => 0,
-to => 1000,
-tickinterval => 200,
-resolution => 1,
-label => "$Translate{'GroundSpeed'} (dm/s)",
-font => '-adobe-helvetica-medium-r-normal--10-100-75-75-p-56-iso8859-1',
-length => 200,
-width => 15,
-variable => \$MkOsd{'GroundSpeed'},
)->grid (-row => $Row + 6,
-rowspan => 4,
-column => $Col,
);
# GPS Speed North
$MkNcDebug{'Analog_21'} = 0;
$scAnalog_21 = $MkTab->Scale(
-orient => 'horizontal',
-from => -1000,
-to => 1000,
-tickinterval => 400,
-resolution => 1,
-label => "$Translate{'Analog_21'} (dm/s)",
-font => '-adobe-helvetica-medium-r-normal--10-100-75-75-p-56-iso8859-1',
-length => 200,
-width => 15,
-variable => \$MkNcDebug{'Analog_21'},
)->grid (-row => $Row + 10,
-rowspan => 4,
-column => $Col,
);
# GPS Speed East
$MkNcDebug{'Analog_22'} = 0;
$scAnalog_22 = $MkTab->Scale(
-orient => 'horizontal',
-from => -1000,
-to => 1000,
-tickinterval => 400,
-resolution => 1,
-label => "$Translate{'Analog_22'} (dm/s)",
-font => '-adobe-helvetica-medium-r-normal--10-100-75-75-p-56-iso8859-1',
-length => 200,
-width => 15,
-variable => \$MkNcDebug{'Analog_22'},
)->grid (-row => $Row + 14,
-rowspan => 4,
-column => $Col,
);
# Variometer
$MkOsd{'Variometer'} = 0;
$scVariometer = $MkTab->Scale(
-orient => 'vertical',
-from => 30,
-to => -30,
-tickinterval => 10,
-resolution => 1,
-label => $Translate{'Variometer'},
-font => '-adobe-helvetica-medium-r-normal--10-100-75-75-p-56-iso8859-1',
-length => 100,
-width => 15,
-variable => \$MkOsd{'Variometer'},
)->grid (-row => $Row,
-rowspan => 2,
-column => $Col + 1,
);
my $DataLink = 1;
$cbDataLink = $MkTab->Checkbutton(
-text => $Translate{'DataLink'},
-offvalue => 0x00,
-onvalue => 0x01,
-variable => \$DataLink,
)->grid (-row => $Row + 2,
-column => $Col +1,
-sticky=>'w',
-ipadx => 10,
);
$MkTab->Label(-text => "", # space
)->grid (-row => $Row +3,
-column => $Col +1,
-sticky=>'w',
-ipadx => 10,
);
$MkTab->Label(-text => "$Translate{'MKFlags'}: --------",
)->grid (-row => $Row +4,
-column => $Col +1,
-sticky=>'w',
-ipadx => 10,
);
my $MkMotorRun = 0;
$cbMkMotorRun = $MkTab->Checkbutton(
-text => $Translate{'MkMotorRun'},
-offvalue => 0x00,
-onvalue => 0x01,
-variable => \$MkMotorRun,
)->grid (-row => $Row + 5,
-column => $Col +1,
-sticky=>'w',
-ipadx => 10,
);
my $MkFly = 0;
$cbMkFly = $MkTab->Checkbutton(
-text => $Translate{'MkFly'},
-variable => \$MkFly,
-offvalue => 0x00,
-onvalue => 0x02,
)->grid (-row => $Row + 6,
-column => $Col +1,
-sticky=>'w',
-ipadx => 10,
);
my $MkCalibrate = 0;
$cbMkCalibrate = $MkTab->Checkbutton(
-text => $Translate{'MkCalibrate'},
-variable => \$MkCalibrate,
-offvalue => 0x00,
-onvalue => 0x04,
)->grid (-row => $Row + 7,
-column => $Col +1,
-sticky=>'w',
-ipadx => 10,
);
my $MkStart = 0;
$cbMkStart = $MkTab->Checkbutton(
-text => $Translate{'MkStart'},
-variable => \$MkStart,
-offvalue => 0x00,
-onvalue => 0x08,
)->grid (-row => $Row + 8,
-column => $Col + 1,
-sticky=>'w',
-ipadx => 10,
);
my $MkEmergency = 0;
$cbMkEmergency = $MkTab->Checkbutton(
-text => $Translate{'MkEmergency'},
-variable => \$MkEmergency,
-offvalue => 0x00,
-onvalue => 0x10,
)->grid (-row => $Row + 9,
-column => $Col + 1,
-sticky=>'w',
-ipadx => 10,
);
$MkTab->Label(-text => "$Translate{'NCFlags'}: --------",
)->grid (-row => $Row + 10,
-column => $Col + 1,
-sticky=>'w',
-ipadx => 10,
);
my $NcFlagFree = 0;
$cbNcFlagFree = $MkTab->Checkbutton(
-text => $Translate{'NcFlagFree'},
-offvalue => 0x00,
-onvalue => 0x01,
-variable => \$NcFlagFree,
)->grid (-row => $Row + 11,
-column => $Col + 1,
-sticky=>'w',
-ipadx => 10,
);
my $NcFlagPH = 0;
$cbNcFlagPH = $MkTab->Checkbutton(
-text => $Translate{'NcFlagPH'},
-offvalue => 0x00,
-onvalue => 0x02,
-variable => \$NcFlagPH,
)->grid (-row => $Row + 12,
-column => $Col + 1,
-sticky=>'w',
-ipadx => 10,
);
my $NcFlagCH = 0;
$cbNcFlagCH = $MkTab->Checkbutton(
-text => $Translate{'NcFlagCH'},
-offvalue => 0x00,
-onvalue => 0x04,
-variable => \$NcFlagCH,
)->grid (-row => $Row + 13,
-column => $Col + 1,
-sticky=>'w',
-ipadx => 10,
);
my $NcFlagRangeLimit = 0;
$cbNcFlagRangeLimit = $MkTab->Checkbutton(
-text => $Translate{'NcFlagRangeLimit'},
-offvalue => 0x00,
-onvalue => 0x08,
-variable => \$NcFlagRangeLimit,
)->grid (-row => $Row + 14,
-column => $Col + 1,
-sticky=>'w',
-ipadx => 10,
);
my $NcFlagNoSerialLink = 0;
$cbNcFlagNoSerialLink = $MkTab->Checkbutton(
-text => $Translate{'NcFlagNoSerialLink'},
-offvalue => 0x00,
-onvalue => 0x10,
-variable => \$NcFlagNoSerialLink,
)->grid (-row => $Row + 15,
-column => $Col + 1,
-sticky=>'w',
-ipadx => 10,
);
my $NcFlagTargetReached = 0;
$cbNcFlagTargetReached = $MkTab->Checkbutton(
-text => $Translate{'NcFlagTargetReached'},
-offvalue => 0x00,
-onvalue => 0x20,
-variable => \$NcFlagTargetReached,
)->grid (-row => $Row + 16,
-column => $Col + 1,
-sticky=>'w',
-ipadx => 10,
);
my $NcFlagManualControl = 0;
$cbNcFlagManualControl = $MkTab->Checkbutton(
-text => $Translate{'NcFlagManualControl'},
-offvalue => 0x00,
-onvalue => 0x40,
-variable => \$NcFlagManualControl
)->grid (-row => $Row + 17,
-column => $Col + 1,
-sticky=>'w',
-ipadx => 10,
);
#
# Tab: MK 2
#
my $Mk2Tab = $book->add( "MikroKopter2", -label=>"MikroKopter 2", );
my $Row = 0;
my $Col = 0;
# Current
$MkOsd{'Current'} = 0;
$scCurrent = $Mk2Tab->Scale(
-orient => 'horizontal',
-from => 0,
-to => 50,
-tickinterval => 10,
-resolution => 1,
-label => "$Translate{'Current'} (A)",
-font => '-adobe-helvetica-medium-r-normal--10-100-75-75-p-56-iso8859-1',
-length => 300,
-width => 15,
-variable => \$MkOsd{'Current'},
)->grid (-row => $Row,
-column => $Col,
);
# Used Capacity
$MkOsd{'UsedCapacity'} = 0;
$scUsedCapacity = $Mk2Tab->Scale(
-orient => 'horizontal',
-from => 0,
-to => 5000,
-tickinterval => 1000,
-resolution => 50,
-label => "$Translate{'UsedCapacity'} (mAh)",
-font => '-adobe-helvetica-medium-r-normal--10-100-75-75-p-56-iso8859-1',
-length => 300,
-width => 15,
-variable => \$MkOsd{'UsedCapacity'},
)->grid (-row => $Row + 1,
-column => $Col,
);
#
# Tab: Simulator
#
my $MkTab = $book->add( "Simulator", -label=>"Simulator", );
my $Row = 0;
my $Col = 0;
# Speed
my $SimSpeed = 20; # km/h
$scSimSpeed = $MkTab->Scale(
-orient => 'horizontal',
-from => 0,
-to => 50,
-tickinterval => 5,
-resolution => 1,
-label => "Speed (km/h)",
-font => '-adobe-helvetica-medium-r-normal--10-100-75-75-p-56-iso8859-1',
-length => 300,
-width => 15,
-variable => \$SimSpeed,
)->grid (-row => $Row,
-column => $Col,
);
# Acceleration
my $SimAcc = 10; # m/s**2
$scSimAcc = $MkTab->Scale(
-orient => 'horizontal',
-from => 0,
-to => 30,
-tickinterval => 5,
-resolution => 0.5,
-label => "Acceleration (m/s**2)",
-font => '-adobe-helvetica-medium-r-normal--10-100-75-75-p-56-iso8859-1',
-length => 300,
-width => 15,
-variable => \$SimAcc,
)->grid (-row => $Row +1,
-column => $Col,
);
my $Speed = 0; # Current Mk Speed
my $SpeedN = 0; # Speed North
my $SpeedE = 0; # Speed East
#
# Timer
#
my $SimTimebase = 100; # Simulator Timebase in ms
$popup->repeat ($SimTimebase, sub
{
lock (%MkOsd); # until end of block
$MkOsd{'MKFlags'} = $MkMotorRun | $MkFly | $MkCalibrate | $MkStart | $MkEmergency;
$MkOsd{'NCFlags'} = $NcFlagFree | $NcFlagPH | $NcFlagCH | $NcFlagRangeLimit |
$NcFlagNoSerialLink | $NcFlagTargetReached | $NcFlagManualControl;
# Calibration sequence
if ( $CalibCount > 0 )
{
$CalibCount ++;
}
if ( $CalibCount > 2 * 1000 / $SimTimebase ) # 2s
{
$cbMkCalibrate-> deselect();
$cbMkStart->deselect();
$cbMkMotorRun->select();
$cbMkFly->select();
$CalibCount = 0;
}
#
# Simulator
#
if ( $Simulator =~ /ON/i and
$MkSim{'Target_Lat'} ne "" and $MkSim{'Target_Lon'} ne "" )
{
# Set Target-Pos
$MkOsd{'TargetPos_Lat'} = $MkSim{'Target_Lat'};
$MkOsd{'TargetPos_Lon'} = $MkSim{'Target_Lon'};
$MkOsd{'TargetPos_Alt'} = $MkSim{'Target_Alt'};
$MkOsd{'TargetPos_Stat'} = 1;
my ($HomeDist, $HomeBearing) = &MapGpsTo($MkOsd{'HomePos_Lat'}, $MkOsd{'HomePos_Lon'},
$MkOsd{'TargetPos_Lat'}, $MkOsd{'TargetPos_Lon'} );
if ( $HomeDist > $MkOsd{'OperatingRadius'} )
{
# Target entsprechend Operation Radius neu berechnen
$HomeDist = $MkOsd{'OperatingRadius'};
($MkOsd{'TargetPos_Lat'}, $MkOsd{'TargetPos_Lon'}) = &MapGpsAt($MkOsd{'HomePos_Lat'}, $MkOsd{'HomePos_Lon'},
$HomeDist, $HomeBearing);
$cbNcFlagRangeLimit->select;
}
else
{
$cbNcFlagRangeLimit->deselect;
}
#
# Mk physics
# Move MK to Target with constant acceleration
#
my ($Dist, $Bearing) = &MapGpsTo($MkOsd{'CurPos_Lat'}, $MkOsd{'CurPos_Lon'},
$MkOsd{'TargetPos_Lat'}, $MkOsd{'TargetPos_Lon'} );
$MkOsd{'TargetPosDev_Dist'} = $Dist * 10; # in dm
$MkOsd{'TargetPosDev_Bearing'} = $Bearing;
my $AccN = $SimAcc * cos (deg2rad $Bearing); # Acceleration North
my $AccE = $SimAcc * sin (deg2rad $Bearing); # Acceleration East
my $t = $SimTimebase / 1000;
$SpeedN = $SpeedN + $AccN * $t; # Speed North
$SpeedE = $SpeedE + $AccE * $t; # Speed East
$Speed = sqrt ($SpeedN * $SpeedN + $SpeedE * $SpeedE);
if ( $Speed >= $SimSpeed/3.6 )
{
# Limit maximum Speed
my $SpeedBearing = rad2deg atan2 ($SpeedE, $SpeedN);
$SpeedN = $SimSpeed/3.6 * cos (deg2rad $SpeedBearing);
$SpeedE = $SimSpeed/3.6 * sin (deg2rad $SpeedBearing);
$Speed = $SimSpeed/3.6;
}
my $BreakDist = 5;
if ( $Dist <= $BreakDist )
{
$Speed = $SimSpeed/3.6 - $SimSpeed/3.6 * (1 - $Dist/$BreakDist);
my $SpeedBearing = rad2deg atan2 ($SpeedE, $SpeedN);
$SpeedN = $Speed * cos (deg2rad $SpeedBearing);
$SpeedE = $Speed * sin (deg2rad $SpeedBearing);
$AccN = 0;
$AccE = 0;
}
# Distance to go in this loop
my $GoDistN = $SpeedN * $t + 0.5 * $AccN * $t * $t;
my $GoDistE = $SpeedE * $t + 0.5 * $AccE * $t * $t;
my $GoDist = sqrt ( $GoDistN * $GoDistN + $GoDistE * $GoDistE);
my $GoBearing = rad2deg atan2 ($GoDistE, $GoDistN);
if ($GoDist > 0 )
{
($MkOsd{'CurPos_Lat'}, $MkOsd{'CurPos_Lon'}) = &MapGpsAt($MkOsd{'CurPos_Lat'}, $MkOsd{'CurPos_Lon'},
$GoDist, $GoBearing);
}
if ( $Dist < $MkSim{'Target_ToleranceRadius'} )
{
$cbNcFlagTargetReached -> select();
}
else
{
$cbNcFlagTargetReached -> deselect();
}
# GPS Groundspeed, North, East
$MkOsd{'GroundSpeed'} = $Speed * 100; # dm/s
$MkNcDebug{'Analog_21'} = $SpeedN * 100;
$MkNcDebug{'Analog_22'} = $SpeedE * 100;
# Heading
if ( $MkSim{'Target_Heading'} != 0 )
{
$scCompassHeading -> set($MkSim{'Target_Heading'});
}
}
# update display
$scAnalog_21 -> set($MkNcDebug{'Analog_21'});
$scAnalog_22 -> set($MkNcDebug{'Analog_22'});
$scTargetPos_Alt -> set($MkOsd{'TargetPos_Alt'});
$scTargetPosDev_Dist -> set ($MkOsd{'TargetPosDev_Dist'});
$scGroundSpeed -> set($MkOsd{'GroundSpeed'});
$scWaypointNumber -> set ($MkOsd{'WaypointNumber'});
$scWaypointIndex -> set ($MkOsd{'WaypointIndex'});
# move MK symbol on canvas
my ($x, $y) = &MapGps2XY ($MkOsd{'CurPos_Lat'}, $MkOsd{'CurPos_Lon'});
$x = $x / $ImgScaleX;
$y = $y / $ImgScaleY;
$canvas->coords ('SimMk', $x, $y, $x + $Dia, $y + $Dia);
# move Home symbol on canvas
my ($x, $y) = &MapGps2XY ($MkOsd{'HomePos_Lat'}, $MkOsd{'HomePos_Lon'});
$x = $x / $ImgScaleX;
$y = $y / $ImgScaleY;
$canvas->coords ('SimHome', $x, $y, $x + $Dia, $y + $Dia);
# move Target symbol on canvas
my ($x, $y) = &MapGps2XY ($MkOsd{'TargetPos_Lat'}, $MkOsd{'TargetPos_Lon'});
$x = $x / $ImgScaleX;
$y = $y / $ImgScaleY;
$canvas->coords ('SimTarget', $x, $y, $x + $Dia, $y + $Dia);
if ( $DataLink)
{
# Timestamp, wann der Datensatz geschrieben wurde
$MkOsd{'_Timestamp'} = time;
}
});
}
# Make MK Fly
sub CbSimMkFly
{
$scWaypointIndex->set(5);
$scWaypointNumber->set(10);
$cbNcFlagCH->select();
# start calibration sequence
$cbMkCalibrate-> select();
$cbMkStart->select();
$CalibCount = 1;
}
# 3D Fix
sub CbSim3DFix
{
my $Alt = 50;
$scCurPos_Alt->set($Alt);
$scAltimeter->set($Alt * $Cfg->{'mkcockpit'}->{'AltFactor'});
$scSatsInUse->set(10);
$cbCurPos_Stat->select();
$cbTargetPos_Stat->select();
$cbHomePos_Stat->select();
# Set Home-Pos to Cur-Pos
$MkOsd{'HomePos_Lat'} = $MkOsd{'CurPos_Lat'};
$MkOsd{'HomePos_Lon'} = $MkOsd{'CurPos_Lon'};
$scGroundSpeed->set(400);
$scAnalog_21->set(10);
$scAnalog_22->set(10);
}
# Switch Simulator ON
sub CbSimStart
{
$Simulator = "ON";
# Only one Target from Player
$MkOsd{'WaypointNumber'} = 1;
$MkOsd{'WaypointIndex'} = 0;
}
# Switch Simulator OFF
sub CbSimStop
{
$Simulator = "OFF";
# switch on logging
$MkOsd{'_Timestamp'} = 0;
$LogQueue->enqueue( "LOG" );
}
1;
__END__

/MissionCockpit/tags/V0.4.0/libmktimer.pl
0,0 → 1,1606
#!/usr/bin/perl
#!/usr/bin/perl -d:ptkdb
###############################################################################
#
# libmktime.pl - MK Mission Cockpit - Timer for GUI Frontend
#
# Copyright (C) 2009 Rainer Walther (rainerwalther-mail@web.de)
#
# Creative Commons Lizenz mit den Zusaetzen (by, nc, sa)
#
# Es ist Ihnen gestattet:
# * das Werk vervielfältigen, verbreiten und öffentlich zugänglich machen
# * Abwandlungen bzw. Bearbeitungen des Inhaltes anfertigen
#
# Zu den folgenden Bedingungen:
# * Namensnennung.
# Sie müssen den Namen des Autors/Rechteinhabers in der von ihm festgelegten Weise nennen.
# * Keine kommerzielle Nutzung.
# Dieses Werk darf nicht für kommerzielle Zwecke verwendet werden.
# * Weitergabe unter gleichen Bedingungen.
# Wenn Sie den lizenzierten Inhalt bearbeiten oder in anderer Weise umgestalten,
# verändern oder als Grundlage für einen anderen Inhalt verwenden,
# dürfen Sie den neu entstandenen Inhalt nur unter Verwendung von Lizenzbedingungen
# weitergeben, die mit denen dieses Lizenzvertrages identisch oder vergleichbar sind.
#
# Im Falle einer Verbreitung müssen Sie anderen die Lizenzbedingungen, unter welche dieses
# Werk fällt, mitteilen. Am Einfachsten ist es, einen Link auf diese Seite einzubinden.
#
# Jede der vorgenannten Bedingungen kann aufgehoben werden, sofern Sie die Einwilligung
# des Rechteinhabers dazu erhalten.
#
# Diese Lizenz lässt die Urheberpersönlichkeitsrechte unberührt.
#
# Weitere Details zur Lizenzbestimmung gibt es hier:
# Kurzform: http://creativecommons.org/licenses/by-nc-sa/3.0/de/
# Komplett: http://creativecommons.org/licenses/by-nc-sa/3.0/de/legalcode
#
###############################################################################
# 2009-08-09 0.2.5 rw Timer moved from mkcockpit.pl
# Optional Player home-pos in map configuration
# 2009-08-23 0.2.6 rw Tracking-Antenna Icon
# POI heading control
# 2009-10-11 0.2.7 rw Tracker control changed
# 2010-02-10 0.4.0 rw Altitude average changed
# Event Engine timer
# Serial channel timer
# External Control rimer
# Crosshair Timer
# 5s timer changed to 3s
# Current, UsedCapacity, Power added
#
###############################################################################
$Version{'libmktimer.pl'} = "0.4.0 - 2010-02-10";
use Math::Trig;
use Time::HiRes qw(gettimeofday); # http://search.cpan.org/~jhi/Time-HiRes-1.9719/HiRes.pm
#
# Timer: 3s
#
$main->repeat (3000, sub
{
if ( ! $MkSendWp )
{
# Abfragefrequenz OSD und Debug regelmäßig neu einstellen, falls Übertragungsfehler
$MkSendQueue->enqueue( "o", "$AddrNC", pack ("C", 10) ); # Frequenz OSD Datensatz, * 10ms
$MkSendQueue->enqueue( "d", "$AddrNC", pack ("C", 10) ); # Frequenz MK Debug Datensatz, * 10ms
$MkSendQueue->enqueue( "v", "$AddrNC", ""); # Version
$MkSendQueue->enqueue( "e", "$AddrNC", ""); # Error Text Request
}
lock (%MkOsd); # until end of block
# Draw Operation Radius Border
$map_canvas->delete('Map-Border-OperatingRadius');
if ( &HomePosIsValid() )
{
my $Radius = $MkOsd{'OperatingRadius'};
my $H_Lat = $MkOsd{'HomePos_Lat'};
my $H_Lon = $MkOsd{'HomePos_Lon'};
my $Angel = &MapAngel();
my ($T_Lat, $T_Lon) = &MapGpsAt ($H_Lat, $H_Lon, $Radius, $Angel -90);
my ($R_Lat, $R_Lon) = &MapGpsAt ($H_Lat, $H_Lon, $Radius, $Angel);
my ($B_Lat, $B_Lon) = &MapGpsAt ($H_Lat, $H_Lon, $Radius, $Angel + 90);
my ($L_Lat, $L_Lon) = &MapGpsAt ($H_Lat, $H_Lon, $Radius, $Angel + 180);
my ($T_x, $T_y) = &MapGps2XY ($T_Lat, $T_Lon);
my ($R_x, $R_y) = &MapGps2XY ($R_Lat, $R_Lon);
my ($B_x, $B_y) = &MapGps2XY ($B_Lat, $B_Lon);
my ($L_x, $L_y) = &MapGps2XY ($L_Lat, $L_Lon);
$map_canvas->createArc ( $L_x, $B_y, $R_x, $T_y,
'-tags' => 'Map-Border-OperatingRadius',
'-extent' => '359',
'-start' => '0',
'-style' => 'chord',
'-outline' => $Cfg->{'mkcockpit'}->{'ColorAirfield'},
'-width' => '1',
);
$map_canvas->raise('Map-Border-OperatingRadius', 'Map'); # Border above Map
}
});
#
# Timer: 0.1s - Map Overlay aktualisieren
#
$frame_map_top->repeat (100, sub
{
# Clear old messages from this timer
&MkMessageInit ("Timer-MapOverlay");
lock (%MkOsd); # until end of block
lock (%MkNcDebug); # until end of block
# Aktuell gültige Karte
%Map = %{$Maps{'Current'}};
if ( &MkOsdIsValid() )
{
# Gueltige OSD Daten
# Operation Mode
$OperationMode = "";
if ( &MkIsWptMode() ) { $OperationMode = "WPT"; }
if ( $PlayerMode eq "Play" ) { $OperationMode = "Play"; }
if ( $PlayerMode eq "Pause" ) { $OperationMode = "Paus"; }
if ( $PlayerMode eq "Home" ) { $OperationMode = "Home"; }
if ( &MkIsPhMode() ) { $OperationMode = "PH"; }
if ( &MkIsFreeMode() ) { $OperationMode = "Free"; }
my $SatsInUse = $MkOsd{'SatsInUse'};
if ( &CurPosIsValid() and &HomePosIsValid() )
{
# ausreichender GPS Empfang
# get x,y map coords of current position
my ($C_x, $C_y, $C_Angel) = &MapGps2XY($MkOsd{'CurPos_Lat'}, $MkOsd{'CurPos_Lon'}, $MkOsd{'CompassHeading'});
$MkPos_x = $C_x;
$MkPos_y = $C_y;
$System{'CurrPos_x'} = $C_x;
$System{'CurrPos_y'} = $C_y;
# rotate MK arrow
my $dy = sin (deg2rad $C_Angel) * ($MapMkLen/2);
my $dx = cos (deg2rad $C_Angel) * ($MapMkLen/2);
my $x0 = $C_x - $dx;
my $y0 = $C_y - $dy;
my $x1 = $C_x + $dx;
my $y1 = $C_y + $dy;
$map_canvas->coords ('MK-Arrow', $x0, $y0, $x1, $y1);
# Update speed vector
my $MapAngel = &MapAngel(); # North to Map-Horizont
my $GpsSpeedNorth = $MkNcDebug{'Analog_21'};
my $GpsSpeedEast = $MkNcDebug{'Analog_22'};
my $PhiGpsSpeed = rad2deg atan2 ( $GpsSpeedEast, $GpsSpeedNorth );
$PhiMapSpeed = $PhiGpsSpeed - $MapAngel;
# 555 cm/s ~ 20 km/h -> Zeigerlänge = $MkSpeedLen bei 20 km/h
my $dy = sin (deg2rad $PhiMapSpeed) * $MapMkSpeedLen * $MkOsd{'GroundSpeed'} / 555;
my $dx = cos (deg2rad $PhiMapSpeed) * $MapMkSpeedLen * $MkOsd{'GroundSpeed'} / 555;
my $x0 = $C_x;
my $y0 = $C_y;
my $x1 = $C_x + $dx;
my $y1 = $C_y + $dy;
$map_canvas->coords ('MK-Speed', $x0, $y0, $x1, $y1);
# Update Line between Home and MK
my ($H_x, $H_y) = &MapGps2XY($MkOsd{'HomePos_Lat'}, $MkOsd{'HomePos_Lon'});
$map_canvas->coords ('MK-Home-Line', $H_x, $H_y, $C_x, $C_y);
# Update Distance between Home and MK
my ($Dist, $Bearing) = &MapGpsTo($MkOsd{'CurPos_Lat'}, $MkOsd{'CurPos_Lon'},
$MkOsd{'HomePos_Lat'}, $MkOsd{'HomePos_Lon'} );
my $x = ($C_x - $H_x) / 2 + $H_x + 8;
my $y = ($C_y - $H_y) / 2 + $H_y + 8;
$map_canvas->coords ('MK-Home-Dist', $x, $y);
$map_canvas->itemconfigure ('MK-Home-Dist',
'-text' => sprintf ("%4d m", int ($Dist + 0.5) ),
);
$System{'HomePos_y'} = $H_x;
$System{'HomePos_x'} = $H_y;
$System{'HomeDist'} = $Dist;
$System{'HomeBearing'} = $Bearing;
# Update OSD - Sat dependent values
$map_canvas->itemconfigure ('MK-OSD-Spd-Value', '-text' => sprintf ("%3d km/h", $MkOsd{'GroundSpeed'} * 0.036) );
# Alt = average Luftdruck und Sat
my $Alt = int (&Altitude() + 0.5);
$map_canvas->itemconfigure ('MK-OSD-Alt-Value', '-text' => sprintf ("%3d m", $Alt) );
$System{'Alt'} = $Alt;
if ( &TargetIsValid() )
{
# Valid Target
# Update Line between Target and MK
my ($T_x, $T_y) = &MapGps2XY($MkOsd{'TargetPos_Lat'}, $MkOsd{'TargetPos_Lon'});
$map_canvas->coords ('MK-Target-Line', $C_x, $C_y, $T_x, $T_y);
# Update Distance between Target and MK
my ($Dist, $Bearing) = &MapGpsTo($MkOsd{'CurPos_Lat'}, $MkOsd{'CurPos_Lon'},
$MkOsd{'TargetPos_Lat'}, $MkOsd{'TargetPos_Lon'} );
$System{'TargetPos_x'} = $T_x;
$System{'TargetPos_y'} = $T_y;
$System{'TargetDist'} = $Dist;
$System{'TargetBearing'} = $Bearing;
if ( $Dist >= 25 )
{
my $x = ($C_x - $T_x) / 2 + $T_x - 8;
my $y = ($C_y - $T_y) / 2 + $T_y + 8;
$map_canvas->coords ('MK-Target-Dist', $x, $y);
$map_canvas->itemconfigure ('MK-Target-Dist',
'-text' => sprintf ("%4d m", int ($Dist + 0.5) ),
);
}
else
{
# Don't show distance < 25m
$map_canvas->coords ('MK-Target-Dist', 0, -100);
}
# show target icon
my $IconHeight = 48;
my $IconWidth = 48;
$map_canvas->coords('Target', $T_x - $IconWidth/2, $T_y - $IconHeight );
$System{'CrossingBorder'} = 0;
if ( &MkIsFlying() and &IsCrossingBorder($MkPos_x, $MkPos_y, $T_x, $T_y) )
{
# only, if MK is flying
$System{'CrossingBorder'} = 1;
&MkMessage ($Translate{'MsgCrossingBorder'}, "Timer-MapOverlay");
}
}
else
{
# No valid Target, move target line out of sight/canvas
$map_canvas->coords ('MK-Target-Line', 0, -100, 0, -100);
$map_canvas->coords ('MK-Target-Dist', 0, -100);
# hide target icon
$map_canvas->coords('Target', 0, -100, );
}
# Update Line between MK and POI
if ( $PoiMode )
{
my ($P_x, $P_y) = &MapGps2XY($Poi_Lat, $Poi_Lon);
$map_canvas->coords ('MK-POI-Line', $P_x, $P_y, $C_x, $C_y);
$System{'PoiPos_x'} = $P_x;
$System{'PoiPos_y'} = $P_y;
}
else
{
$map_canvas->coords ('MK-POI-Line', 0, -200, 0, -200);
}
}
else
{
# kein ausreichender Sat-Empfang
$map_canvas->itemconfigure ('MK-OSD-Spd-Value', '-text' => sprintf ("%3d km/h", 0 ) );
}
# Update OSD - non Sat dependent values
$map_canvas->itemconfigure ('MK-OSD-Odo-Value', '-text' => sprintf ("%3.3f km", $OdoMeter / 1000) );
$map_canvas->itemconfigure ('MK-OSD-Tim-Value', '-text' => sprintf ("%02d:%02d", $MkFlyingTime / 60, $MkFlyingTime % 60) );
$map_canvas->itemconfigure ('MK-OSD-Sat-Value', '-text' => $MkOsd{'SatsInUse'} );
$map_canvas->itemconfigure ('MK-OSD-Cur-Value', '-text' => sprintf ("%.1f A", $MkOsd{'Current'}) );
# Used Capacity
my $UsedCapacityFactor = $Cfg->{'map'}->{'UsedCapacityFactor'} || "1.0";
$System{'UsedCapacity'} = $MkOsd{'UsedCapacity'} * $UsedCapacityFactor;
$map_canvas->itemconfigure ('MK-OSD-Cap-Value', '-text' => sprintf ("%.2f Ah", $System{'UsedCapacity'} / 1000) );
# Power
$System{'Power'} = int ($MkOsd{'Current'} * $MkOsd{'UBat'} + 0.5);
$map_canvas->itemconfigure ('MK-OSD-Pow-Value', '-text' => sprintf ("%d W", $System{'Power'} ) );
# battery - OSD and warning
my $UBat = sprintf ("%3.1f", $MkOsd{'UBat'});
$System{'UBat'} = $UBat;
$map_canvas->itemconfigure ('MK-OSD-Bat-Value', '-text' => "$UBat V" );
$System{'BatWarning'} = 0;
$map_canvas->itemconfigure ('MK-OSD-Bat-Value', '-fill' => $Cfg->{'mkcockpit'}->{'ColorOsd'});
if ( $MkOsd{'UBat'} < $Cfg->{'mkcockpit'}->{'UBatWarning'} )
{
if ( time %2 )
{
$map_canvas->itemconfigure ('MK-OSD-Bat-Value', '-fill' => 'red');
}
&MkMessage ($Translate{'MsgBatWarning'}, "Timer-MapOverlay");
$System{'BatWarning'} = 1;
}
# Display Operation Mode
my $DisplayMode = $OperationMode;
if ( &MkIsWptMode() and $OperationMode eq "Play" )
{
my %ModeMatrix =
(
"KML-STD" => "Play KML",
"KML-RND" => "Play KML",
"KML-MAP" => "Play KML",
"WPT-STD" => "Play WPT",
"WPT-RND" => "Rand WPT",
"WPT-MAP" => "Rand MAP",
);
my $Key = "${PlayerWptKmlMode}-${PlayerRandomMode}";
$DisplayMode = $ModeMatrix{$Key};
}
if ( &MkIsWptMode() and $OperationMode eq "Paus" )
{
$DisplayMode = $DisplayMode . " " . $PlayerPauseMode;
}
$System{'RangeWarning'} = 0;
if ( &MkRangeLimit() )
{
$DisplayMode = "$DisplayMode" . " !!"; # Range Warning
$System{'RangeWarning'} = 1;
}
$map_canvas->itemconfigure ('MK-OSD-Mode-Value', '-text' => $DisplayMode );
# Waypoints abhaengig vom Modus NC/Player
my $WpValue = "-- / --";
if ( $MkOsd{'WaypointNumber'} > 0)
{
$WpValue = sprintf ("%d / %d", $MkOsd{'WaypointIndex'}, $MkOsd{'WaypointNumber'});
}
if ($PlayerMode ne "Stop" and $PlayerWptKmlMode eq "WPT")
{
$WpValue = sprintf ("%d / %d", $WpPlayerIndex +1, scalar @Waypoints);
}
if ($PlayerMode ne "Stop" and $PlayerWptKmlMode eq "KML" )
{
my $KmlTimeBase = $Cfg->{'waypoint'}->{'KmlTimeBase'} || 1.0;
my $CurrTime = int ($KmlPlayerIndex * $KmlTimeBase + 0.5);
my $TotTime = int (scalar @KmlTargets * $KmlTimeBase + 0.5);
$WpValue = sprintf ("%02d:%02d / %02d:%02d", $CurrTime / 60, $CurrTime % 60, $TotTime / 60, $TotTime % 60);
}
$map_canvas->itemconfigure ('MK-OSD-Wp-Value', '-text' => "$WpValue");
# Recording Mode
my $RecordText = "";
if ( $PlayerRecordMode =~ /REC/i )
{
my $KmlTimeBase = $Cfg->{'waypoint'}->{'KmlTimeBase'} || 1.0;
my $TotTime = int (scalar @KmlTargets * $KmlTimeBase + 0.5);
$RecordText = sprintf ("Recording %02d:%02d", $TotTime / 60, $TotTime % 60);
}
$map_canvas->itemconfigure ('MK-OSD-Rec-Value', '-text' => $RecordText );
# Farbe MK-Zeiger abhängig vom GPS Empfang
my $MkCol= $Cfg->{'mkcockpit'}->{'ColorMkSatNo'};
if ( $SatsInUse >= 1 ) { $MkCol = $Cfg->{'mkcockpit'}->{'ColorMkSatLow'} ; }
if ( $SatsInUse >= 6 ) { $MkCol = $Cfg->{'mkcockpit'}->{'ColorMkSatGood'}; }
$map_canvas->itemconfigure ('MK-Arrow', '-fill' => $MkCol);
# Show/Hide SatFix Icon
if ($SatsInUse >= 6 )
{
$map_canvas->coords('Satellite', $MapSizeX-100, 10, );
}
else
{
# move icon out of sight
$map_canvas->coords('Satellite', 0, -100, );
}
# Variometer Pointer
my $dy = -$MkOsd{'Variometer'} * 10;
$map_canvas->coords('Map-Variometer-Pointer', 5, $MapSizeY/2+$dy, 20, $MapSizeY/2+10+$dy, 20, $MapSizeY/2-10+$dy);
#
# System checks
#
if ( ! &MkIsMotorOn() ) { &MkMessage ($Translate{'MsgMotorOff'}, "Timer-MapOverlay"); }
if ( ! &MkIsFlying() ) { &MkMessage ($Translate{'MsgNotFlying'}, "Timer-MapOverlay"); }
if ( &MkIsCalibrating() ) { &MkMessage ($Translate{'MsgCalibrate'}, "Timer-MapOverlay"); }
if ( &MkIsMotorStarting() ) { &MkMessage ($Translate{'MsgStart'}, "Timer-MapOverlay") }
if ( &MkEmergencyLanding() ) { &MkMessage ($Translate{'MsgEmergencyLanding'}, "Timer-MapOverlay"); }
if ( &MkRangeLimit() ) { &MkMessage ($Translate{'MsgRangeLimit'}, "Timer-MapOverlay"); }
# RC range check
my $RcQuality = $MkOsd{'RC_Quality'};
$System{'RCQuality'} = "";
if ( $RcQuality < 100 )
{
$System{'RCQuality'} = "NO";
&MkMessage ($Translate{'MsgRcError'}, "Timer-MapOverlay");
}
elsif ( $RcQuality < 150 )
{
$System{'RCQuality'} = "WEAK";
&MkMessage ($Translate{'MsgRcWarning'}, "Timer-MapOverlay");
}
# Sat reception quality
if ( $SatsInUse == 0 )
{
&MkMessage ($Translate{'MsgNoSatReception'}, "Timer-MapOverlay");
}
elsif ( $SatsInUse > 0 and $SatsInUse < 6 )
{
&MkMessage ($Translate{'MsgWeakSatReception'}, "Timer-MapOverlay");
}
# MK Border check
$System{'OutsideBorder'} = "0";
if ( &MkIsFlying() and ! &IsInsideBorder($MkPos_x, $MkPos_y) )
{
# only, if MK is flying
$System{'OutsideBorder'} = "1";
&MkMessage ($Translate{'MsgOutsideBorder'}, "Timer-MapOverlay");
}
# Show Balloon, when aproaching Target
&TargetMessageShow();
}
else
{
# keine aktuellen OSD Daten vom MK verfügbar
&MkMessage ($Translate{'MsgNoData'}, "Timer-MapOverlay");
}
# Wp-Number input from keyboard
$KbTimer++;
if ( $CbPlayerKey ne "" )
{
# Key pressed
$KbNum = "$KbNum" . "$CbPlayerKey";
$CbPlayerKey = "";
$KbTimer = 0;
}
if ( $KbTimer > 7 and $KbNum ne "" )
{
# number complete, set target
my $WpIndex = sprintf ("%d", $KbNum);
&WpTargetSet ($WpIndex - 1);
# prepare for next number
$KbNum = "";
}
# Show System Messages
&MkMessageShow();
# display transmit status in top status line
my $Color = 'lightgray';
my $Relief = 'flat';
if ( $Cfg->{'serialchannel'}->{'SerialChannelSend'} =~ /y/i )
{
$Color = 'green';
$Relief = 'sunken';
}
if ($TxExtOn == 0 )
{
$Color = 'red';
$Relief = 'sunken';
}
$map_status_top[0]->configure (-text => "Tx:$Translate{'serialchannel'}",
-background => $Color,
-relief => $Relief,
);
my $Color = 'lightgray';
my $Relief = 'flat';
if ( $Cfg->{'externcontrol'}->{'ExternControlSend'} =~ /y/i )
{
$Color = 'green';
$Relief = 'sunken';
}
if ($TxExtOn == 0 )
{
$Color = 'red';
$Relief = 'sunken';
}
$map_status_top[1]->configure (-text => "Tx:$Translate{'externcontrol'}",
-background => $Color,
-relief => $Relief,
);
# display event status in lower status line, max. 10 fields
my @Event = sort keys %{$Event};
my $EventIndex = 0;
while ( $EventIndex < 10 )
{
my $Key = pop @Event;
my $Color = 'lightgray';
my $Relief = 'flat';
if ( $Key eq "" )
{
# clear unused fields
$map_status_event[$EventIndex]->configure (-text => $Key,
-background => $Color,
-relief => $Relief,
);
$EventIndex ++;
}
elsif ( ref $Event->{$Key} ne "" and $Event->{$Key}->{'Active'} =~ /y/i )
{
if ( $EventStat{$Key}{'Status'} eq "ON" )
{
$Color = 'green';
$Relief = 'sunken';
}
elsif ( $EventStat{$Key}{'Status'} eq "OFF" )
{
$Color = 'red';
$Relief = 'sunken';
}
$map_status_event[$EventIndex]->configure (-text => $Key,
-background => $Color,
-relief => $Relief,
);
$EventIndex ++;
}
else
{
# don't display disabled events
}
}
});
#
# Timer: 0.1s - Tracking Anzeige aktualisieren
#
if ( $Cfg->{'track'}->{'Active'} =~ /y/i )
{
$TrackMkCalibrateEdge = 0; # calibrate edge detection
$frame_map_top->repeat (100, sub
{
# Clear old messages from this timer
&MkMessageInit ("Timer-Tracking");
lock (%MkOsd); # until end of block
lock (%MkTrack); # until end of block
# Aktuell gültige Karte
%Map = %{$Maps{'Current'}};
# Zeiger neu zeichnen
my $AngelPan = @ServoPos[$MkTrack{'ServoPan'}];
my $AngelTilt = @ServoPos[$MkTrack{'ServoTilt'}];
if ( $AngelPan ne "" and $AngelTilt ne "" )
{
my $Angel = $AngelPan;
if ( $AngelTilt > 90 )
{
$Angel += 180;
}
# Pan
my $x0 = $TrackSizeX/2;
my $y0 = $TrackSizeY - 0 - $TrackOffY;
my $x1 = $TrackSizeX/2 - ($TrackPtrLen-22) * cos( deg2rad $Angel);
my $y1 = $TrackSizeY - ($TrackPtrLen-22) * sin (deg2rad $Angel) - $TrackOffY;
$track_canvas->coords ('Track-Ptr-Pan', $x0, $y0, $x1, $y1);
# Tilt
my $x0 = $TrackSizeX/2;
my $y0 = $TrackSizeY - 0 - $TrackOffY;
my $x1 = $TrackSizeX/2 - ($TrackPtrLen-22) * cos( deg2rad 180 - $AngelTilt);
my $y1 = $TrackSizeY - ($TrackPtrLen-22) * sin (deg2rad 180 - $AngelTilt) - $TrackOffY;
$track_canvas->coords ('Track-Ptr-Tilt', $x0, $y0, $x1, $y1);
}
# Farbe Zeiger abhängig vom GPS Empfang
my $SatsInUse = $MkOsd{'SatsInUse'};
my $TrackPtrCol= 'red';
if ( $SatsInUse >= 1 ) { $TrackPtrCol = 'orange'; }
if ( $SatsInUse >= 6 ) { $TrackPtrCol = 'green'; }
$track_canvas->itemconfigure ('Track-Ptr-Pan', '-fill' => $TrackPtrCol);
# tracker coldstart condition at MK calibration, rising edge of signal
if ( &MkIsCalibrating() )
{
if ( $TrackMkCalibrateEdge == 0 )
{
$TrackMkCalibrateEdge = 1;
# send coldstart command to tracker
$TrackQueue->enqueue("COLDSTART");
}
}
else
{
$TrackMkCalibrateEdge = 0;
}
});
}
#
# Timer: 0.5s - Waypoint Player
#
$frame_map_top->repeat (500, sub
{
# Clear old messages from this timer
&MkMessageInit ("Timer-Player");
lock (%MkOsd); # until end of block
if ( &MkIsWptMode() )
{
# NC is in WPT Mode
my $PoiBearing = $Cfg->{'waypoint'}->{'DefaultHeading'};
if ( &CurPosIsValid() and $PoiMode )
{
$PoiBearing = &MapGpsTo ( $MkOsd{'CurPos_Lat'}, $MkOsd{'CurPos_Lon'},
$Poi_Lat, $Poi_Lon );
$System{'PoiBearing'} = $PoiBearing;
}
if ( $PlayerMode eq "Pause" )
{
if ( $PlayerPause_Lat ne "" and $PlayerPause_Lon ne "" )
{
# Gespeicherte Pausen-Pos senden
&MkFlyTo ( '-lat' => $PlayerPause_Lat,
'-lon' => $PlayerPause_Lon,
'-holdtime' => "60",
'-heading' => $PoiBearing,
'-mode' => "Target",
);
}
}
if ( $PlayerMode eq "Home" and &HomePosIsValid() )
{
# Gespeicherte oder eingestellte Home-Pos senden
my $Home_Lat = $Map{'Home_Lat'} || $MkOsd{'HomePos_Lat'};
my $Home_Lon = $Map{'Home_Lon'} || $MkOsd{'HomePos_Lon'};
&MkFlyTo ( '-lat' => $Home_Lat,
'-lon' => $Home_Lon,
'-holdtime' => "60",
'-heading' => $PoiBearing,
'-mode' => "Target",
);
}
if ( $PlayerWptKmlMode ne 'WPT' )
{
# not in Wp mode
return;
}
if ( $PlayerMode eq "Play" )
{
if ( $PlayerRandomMode =~ /RND/i or $PlayerRandomMode =~ /STD/i )
{
my $WpCnt = scalar @Waypoints;
if ( $WpCnt > 0 and $WpPlayerIndex < $WpCnt )
{
# Target WP-Pos senden
my $Wp = $Waypoints[$WpPlayerIndex];
my $Wp_Lon = $Wp->{'Pos_Lon'};
my $Wp_Lat = $Wp->{'Pos_Lat'};
if ( $Wp_Lat ne "" and $Wp_Lon ne "" )
{
&MkFlyTo ( '-lat' => $Wp_Lat,
'-lon' => $Wp_Lon,
'-holdtime' => "60",
'-heading' => $PoiBearing,
'-mode' => "Target",
);
}
}
}
if ( $PlayerRandomMode =~ /MAP/i )
{
# Target Map-Pos senden
&MkFlyTo ( '-x' => $RandomTarget_x ,
'-y' => $RandomTarget_y ,
'-holdtime' => "60",
'-heading' => $PoiBearing,
'-mode' => "Target",
);
}
# Ziel erreicht?
if ( &WpCheckTargetReached() )
{
&WpTargetNext();
}
}
}
# WP Player Holdtime count down
if ( $WpPlayerHoldtime > 0 )
{
$WpPlayerHoldtime --;
}
});
#
# Timer: variabel - KML Player
#
my $KmlTimeBase = $Cfg->{'waypoint'}->{'KmlTimeBase'} || 1.0;
$KmlTimeBase *= 1000;
$frame_map_top->repeat ($KmlTimeBase, sub
{
# Clear old messages from this timer
&MkMessageInit ("Timer-KMLPlayer");
lock (%MkOsd); # until end of block
if ( &CurPosIsValid() and $PlayerRecordMode =~ /REC/i )
{
# record current position
push @KmlTargets, {
'Lat' => $MkOsd{'CurPos_Lat'},
'Lon' => $MkOsd{'CurPos_Lon'},
'Alt' => $MkOsd{'CurPos_Alt'},
};
}
if ( &MkIsWptMode() and $PlayerMode eq "Play" and $PlayerWptKmlMode eq 'KML')
{
# Play KML
# Pause, Home is handled in WPT-Timer
my $KmlCnt = scalar @KmlTargets;
if ( $KmlCnt > 0 and $KmlPlayerIndex < $KmlCnt )
{
my $Lat = $KmlTargets[$KmlPlayerIndex]->{'Lat'};
my $Lon = $KmlTargets[$KmlPlayerIndex]->{'Lon'};
my $Alt = $KmlTargets[$KmlPlayerIndex]->{'Alt'};
&MkFlyTo ( '-lat' => $Lat,
'-lon' => $Lon,
'-alt' => $Alt,
'-holdtime' => "60",
'-mode' => "Target",
);
# proceed to next Target
$KmlPlayerIndex ++;
if ( $KmlPlayerIndex >= $KmlCnt )
{
$KmlPlayerIndex = 0;
}
}
}
});
#
# Timer: 1s
#
$frame_map_top->repeat (1000, sub
{
# Clear old messages from this timer
&MkMessageInit ("Timer-Misc-1s");
lock (%MkOsd); # until end of block
# Aktuell gültige Karte
%Map = %{$Maps{'Current'}};
if ( &MkOsdIsValid() )
{
# Heartbeat MK Datenübertragung
if ( time %2 )
{
$map_canvas->itemconfigure('Heartbeat', '-image' => 'HeartbeatLarge', );
}
else
{
$map_canvas->itemconfigure('Heartbeat', '-image' => 'HeartbeatSmall', );
}
# Flugzeit aktualisieren
# Flugzeit selber mitzählen, da $MkOsd{'FlyingTime'} immer 0 (0.14b)
if ( &MkIsFlying() )
{
$MkFlyingTime += 1;
}
# Update ODO-Meter
if ( &CurPosIsValid() )
{
my $C_Lat = $MkOsd{'CurPos_Lat'};
my $C_Lon = $MkOsd{'CurPos_Lon'};
if ( $OdoFirst ne "" )
{
my ($Dist, $Bearing) = &MapGpsTo($C_Lat, $C_Lon, $OdoPos_Lat, $OdoPos_Lon );
$OdoMeter += $Dist;
}
$OdoPos_Lat = $C_Lat;
$OdoPos_Lon = $C_Lon;
$OdoFirst = "1";
}
# # Estimate remaining flight time
# my $TextTimeLeft = "";
# if ( &MkIsFlying() and $Capacity <= 90 )
# {
# my $MaxTime = 100.0 / (100.0 - $Capacity) * $MkFlyingTime;
# my $TimeLeft = $MaxTime - $MkFlyingTime;
# $TextTimeLeft = sprintf ("(%d min)", int ($TimeLeft / 60.0 + 0.8) );
# }
# $map_canvas->itemconfigure ('MK-OSD-Tim-Left', '-text' => $TextTimeLeft );
# Footprint
if ( $Cfg->{'mkcockpit'}->{'FootprintLength'} > 0 )
{
if ( &CurPosIsValid() )
{
# neuen Footprint hinten anhaengen
my ($x, $y) = &MapGps2XY($MkOsd{'CurPos_Lat'}, $MkOsd{'CurPos_Lon'});
push @Footprint, $x, $y;
}
while ( $#Footprint / 2 > $Cfg->{'mkcockpit'}->{'FootprintLength'} )
{
# alte Footprints entfernen
splice @Footprint, 0, 2;
}
&FootprintRedraw();
}
# show tracking antenna icon
if ( $MkTrack{'HomePos_Lat'} ne "" and $MkTrack{'HomePos_Lon'} ne "" )
{
# show antenna icon
my ($x, $y) = &MapGps2XY($MkTrack{'HomePos_Lat'}, $MkTrack{'HomePos_Lon'});
my $IconHeight = 48;
my $IconWidth = 48;
$map_canvas->coords('Track-Antenna', $x - $IconWidth/2, $y - $IconHeight );
}
else
{
# move icon out of sight
$map_canvas->coords('Track-Antenna', 0, -50 );
}
if ( $GridIsOn )
{
# redraw Grid on canvas
&GridHide();
&GridShow();
}
# fun :-)
if ( int rand (100) == 43 )
{
&TtsSpeak ('LOW', $Translate{'TtsFun'});
}
}
});
#
# Timer: 1s - TTS Sprachausgabe
#
$frame_map_top->repeat (1000, sub
{
# Aktuell gültige Karte
%Map = %{$Maps{'Current'}};
lock (%MkOsd); # until end of block
my $StatusInterval = $Cfg->{'tts'}->{'StatusInterval'} || "30";
$SpeechTimer ++;
my @TtsMsg;
if ( &MkOsdIsValid() )
{
# Gueltige OSD Daten
if ( $SpeechTimer % $StatusInterval == 0 )
{
#
# give system status, low prio messages
#
# clear old low prio messages
&TtsClear('LOW');
# get messages from configuration
for ( $Message = 1; $Message < 10; $Message ++)
{
my $MsgId = sprintf ("Message%d", $Message);
my $Msg = $Cfg->{'tts'}{$MsgId};
if ( $Msg =~ /FLIGHT_TIME/i )
{
# Flight time
my $Min = int ( ($MkFlyingTime +1) / 60);
my $Sec = int ( ($MkFlyingTime +1) % 60);
my $Text = sprintf ("$Translate{'TtsFlightTimeMinSec'}", $Min, $Sec);
if ( $Min == 0 )
{
$Text = sprintf ("$Translate{'TtsFlightTimeSec'}", $Sec);
}
&TtsSpeak ('LOW', "$Text");
}
elsif ( $Msg =~ /BATTERY/i )
{
# Battery
my ($Volt, $Tenth) = split '\.', $System{'UBat'};
&TtsSpeak ('LOW', sprintf ("$Translate{'TtsBattery'}", $Volt, $Tenth));
}
elsif ( $Msg =~ /ALTITUDE/i )
{
# Altitude
if ( $System{'Alt'} < 0 )
{
&TtsSpeak ('LOW', sprintf ("$Translate{'TtsAltitudeNegative'}", abs($System{'Alt'}) ) );
}
else
{
&TtsSpeak ('LOW', sprintf ("$Translate{'TtsAltitude'}", $System{'Alt'} ) );
}
}
elsif ( $Msg =~ /SATELLITES/i )
{
# Satellites
&TtsSpeak ('LOW', sprintf ("$Translate{'TtsSatellite'}", $MkOsd{'SatsInUse'}) );
}
elsif ( $Msg =~ /HOME_DIST/i )
{
# Home Distance
&TtsSpeak ('LOW', sprintf ("$Translate{'TtsHomeDist'}", $System{'HomeDist'}) );
}
elsif ( $Msg =~ /TARGET_DIST/i )
{
# Target Distance
&TtsSpeak ('LOW', sprintf ("$Translate{'TtsTargetDist'}", $System{'TargetDist'}) );
}
elsif ( $Msg ne "" )
{
# text or perl code
&TtsSpeak ('LOW', eval "$Msg" );
}
}
}
# high prio messages
if ( $SpeechTimer % 5 == 0 )
{
if ( $System{'BatWarning'} ) { push @TtsMsg, $Translate{'TtsBatteryWarning'}; }
if ( $System{'RCQuality'} eq "WEAK" ) { push @TtsMsg, $Translate{'TtsRcWeak'}; }
if ( $System{'RCQuality'} eq "NO" ) { push @TtsMsg, $Translate{'TtsRcNo'}; }
if ( $System{'CrossingBorder'} ) { push @TtsMsg, $Translate{'TtsCrossingBorder'}; }
if ( $System{'OutsideBorder'} ) { push @TtsMsg, $Translate{'TtsOutsideAirfield'}; }
if ( $System{'RangeWarning'} ) { push @TtsMsg, $Translate{'TtsRange'}; }
}
}
else
{
# no data link
if ( $SpeechTimer % 5 == 0 )
{
push @TtsMsg, $Translate{'TtsNoDataLink'};
}
}
# speak high prio messages
if ( scalar @TtsMsg > 0 )
{
# Clear pending messsages
&TtsClear('HIGH');
# Speak collected messages
foreach $Msg (@TtsMsg)
{
&TtsSpeak ('HIGH', $Msg);
}
}
});
#
# Event engine
#
$frame_map_top->repeat (50, sub # 50ms
{
foreach $Key (keys %{$Event})
{
if ( ref $Event->{$Key} eq "" )
{
# ignore: CreationDate, Version
next;
}
my $Active = $Event->{$Key}->{'Active'};
my $Trigger = $Event->{$Key}->{'Trigger'}; # RISE, FALL, TOGGLE_RISE, TOGGLE_FALL, TRUE, FALSE
my $Condition = $Event->{$Key}->{'Condition'}; # Perl commands, Return 1, if Condition is true
my $Action = $Event->{$Key}->{'Action'}; # Perl commands
my $ActionElse = $Event->{$Key}->{'ActionElse'}; # Perl commands
my $Delay = $Event->{$Key}->{'Delay'}; # Action rearm delay in ms
my $Repeat = $Event->{$Key}->{'Repeat'}; # Action repeat time in ms
my $RepeatElse = $Event->{$Key}->{'RepeatElse'}; # ActionElse repeat time in ms
my $DoAction = 0;
if ( $Active =~ /y/i and $Condition ne "" )
{
# Provide info about current Event
%MyEvent = %{$Event->{$Key}};
$MyEvent{'EventName'} = $Key;
# lock all shared hashes, which might me used in eval-code
lock (%MkOsd); # until end of block
lock (%MkSerialChannel); # until end of block
lock (%Stick); # until end of block
lock (%MkNcDebug); # until end of block
# compile and execute condition at runtime. Return 1, if Condition is true
my $CondStat = eval "$Condition";
if ( $@ ne "" )
{
# print compiler message to STDOUT
print "Event $Key: Condition: $@";
}
# current time for Delay, Repeat timing
my ($t0_s, $t0_us) = gettimeofday;
# for Condition edge detection
my $LastCondStat = $EventStat{$Key}{'LastCondValue'};
$EventStat{$Key}{'LastCondValue'} = $CondStat;
# some flags
my $Rise = (! $LastCondStat and $CondStat);
my $Fall = ( $LastCondStat and ! $CondStat);
my $True = $CondStat;
my $False = ! $CondStat;
# Delay time check
my $DelayCheck = 1;
my $t1_s = $EventStat{$Key}{'DelayTime_s'};
my $t1_us = $EventStat{$Key}{'DelayTime_us'};
if ( $Delay ne "" and $t1_s ne "" and $t1_us ne "" )
{
my $Diff_ms = ($t0_s - $t1_s) * 1000 + ($t0_us - $t1_us) / 1000;
if ( $Diff_ms < $Delay )
{
$DelayCheck = 0;
}
}
#
# rising or falling edge
#
if ( ($Trigger eq "RISE" and $Rise) or
($Trigger eq "FALL" and $Fall) )
{
$DoAction = $DelayCheck;
if ( $DoAction )
{
$EventStat{$Key}{'DelayTime_s'} = $t0_s;
$EventStat{$Key}{'DelayTime_us'} = $t0_us;
# reset Repeat time when event gets active
$EventStat{$Key}{'RepeatTime_s'} = 0;
$EventStat{$Key}{'RepeatTime_us'} = 0;
# reset event counter
$EventStat{$Key}{'EventCnt'} = 0;
}
}
#
# toggle on rising/falling edge
#
elsif ( $Trigger =~ /TOGGLE/i )
{
$DoAction = 0;
if ( ($Rise and $Trigger eq "TOGGLE_RISE") or
($Fall and $Trigger eq "TOGGLE_FALL") )
{
$DoAction = $DelayCheck;
if ( $DoAction )
{
$EventStat{$Key}{'DelayTime_s'} = $t0_s;
$EventStat{$Key}{'DelayTime_us'} = $t0_us;
# reset Repeat time when event gets active
$EventStat{$Key}{'RepeatTime_s'} = 0;
$EventStat{$Key}{'RepeatTime_us'} = 0;
# reset event counter
$EventStat{$Key}{'EventCnt'} = 0;
}
}
if ( $DoAction )
{
$EventStat{$Key}{'ToggleOnOff'} ^= 1;
}
$DoAction = $EventStat{$Key}{'ToggleOnOff'};
}
#
# TRUE Condition
#
elsif ( $Trigger eq "TRUE" )
{
if ( $True )
{
$DoAction = $DelayCheck;
if ( $DoAction and $Rise)
{
# reset Repeat time when event gets active
$EventStat{$Key}{'RepeatTime_s'} = 0;
$EventStat{$Key}{'RepeatTime_us'} = 0;
# reset event counter
$EventStat{$Key}{'EventCnt'} = 0;
}
}
if ( $Fall )
{
# set Delay reference from falling edge
if ( $DelayCheck )
{
# timestamp of last falling Condition edge change
$EventStat{$Key}{'DelayTime_s'} = $t0_s;
$EventStat{$Key}{'DelayTime_us'} = $t0_us;
# reset event counter
$EventStat{$Key}{'EventCnt'} = 0;
}
}
}
#
# FALSE Condition
#
elsif ( $Trigger eq "FALSE" )
{
if ( $False )
{
$DoAction = $DelayCheck;
if ( $DoAction and $Fall)
{
# reset Repeat time when event gets active
$EventStat{$Key}{'RepeatTime_s'} = 0;
$EventStat{$Key}{'RepeatTime_us'} = 0;
# reset event counter
$EventStat{$Key}{'EventCnt'} = 0;
}
}
if ( $Rise )
{
# set Delay reference from rising edge
if ( $DelayCheck )
{
# timestamp of last rising Condition edge change
$EventStat{$Key}{'DelayTime_s'} = $t0_s;
$EventStat{$Key}{'DelayTime_us'} = $t0_us;
# reset event counter
$EventStat{$Key}{'EventCnt'} = 0;
}
}
}
else
{
# unkown, fall through
}
# undefined Status, neither ON, nor OFF
$EventStat{$Key}{'Status'} = "";
#
# Process Action
#
if ( $DoAction and $Action ne "" )
{
$EventStat{$Key}{'Status'} = "ON";
my $Execute = 1;
my $t1_s = $EventStat{$Key}{'RepeatTime_s'};
my $t1_us = $EventStat{$Key}{'RepeatTime_us'};
if ( $Repeat ne "" and $t1_s ne "" and $t1_us ne "" )
{
my $Diff_ms = ($t0_s - $t1_s) * 1000 + ($t0_us - $t1_us) / 1000;
if ( $Diff_ms < $Repeat )
{
$Execute = 0;
}
}
if ( $Execute )
{
# Accounting
$MyEvent{'EventCnt'} = $EventStat{$Key}{'EventCnt'} ++;
# compile and execute action at runtime
eval "$Action";
if ( $@ ne "" )
{
# print compiler message to STDOUT
print "Event $Key: Action: $@";
}
# Timestamp, when Action was executed
$EventStat{$Key}{'RepeatTime_s'} = $t0_s;
$EventStat{$Key}{'RepeatTime_us'} = $t0_us;
# reset ActionElse repeat timing
$EventStat{$Key}{'RepeatTimeElse_s'} = 0;
$EventStat{$Key}{'RepeatTimeElse_us'} = 0;
}
}
#
# Process ActionElse
#
if ( ! $DoAction and $ActionElse ne "" )
{
$EventStat{$Key}{'Status'} = "OFF";
my $Execute = 1;
# check repeat time
my $t1_s = $EventStat{$Key}{'RepeatTimeElse_s'};
my $t1_us = $EventStat{$Key}{'RepeatTimeElse_us'};
if ( $RepeatElse ne "" and $t1_s ne "" and $t1_us ne "" )
{
my $Diff_ms = ($t0_s - $t1_s) * 1000 + ($t0_us - $t1_us) / 1000;
if ( $Diff_ms < $RepeatElse )
{
$Execute = 0;
}
}
if ( $Execute )
{
# Accounting
$MyEvent{'EventCnt'} = $EventStat{$Key}{'EventCnt'} ++;
# compile and execute action at runtime
eval "$ActionElse";
if ( $@ ne "" )
{
# print compiler message to STDOUT
print "Event $Key: ActionElse: $@";
}
# Timestamp, when ActionElse was executed
$EventStat{$Key}{'RepeatTimeElse_s'} = $t0_s;
$EventStat{$Key}{'RepeatTimeElse_us'} = $t0_us;
}
}
}
else
{
$EventStat{$Key}{'Status'} = "DISABLED";
}
}
});
# parse input controls for one output channel
# Syntax: Control1_Reverse,min,max,expo,limit + Control2,min,max,expo,limit + ...
sub ParseControls
{
my ($Channel, $ControlVal, $Expo, $Limit) = @_;
# Channel output can be sum of multiple input controls
$ChannelVal = 0;
$ControlVal =~ s/ //g;
@Controls = split '\+', $ControlVal;
foreach $ControlVal (@Controls)
{
my ($Control, $Min, $Max, $ControlExpo, $ControlLimit) = split ',', $ControlVal;
if ( $Min eq "" ) { $Min = -125; }
if ( $Max eq "" ) { $Max = 125; }
my ($Control, $Reverse) = split '_', $Control;
my $Val = 0;
if ( $Control ne "" )
{
# Joystick Button
if ( $Control =~ /^JoystickButton(\d+)/i )
{
my $Button = $1 - 1;
$ChannelVal = $Min;
if ( &JoystickButton($Button) )
{
$Val = $Max;
}
}
# Joystick POV Button
elsif ( $Control =~ /^JoystickPov(\d+)/i )
{
my $Angle = $1;
my $Pov = $Stick{'JoystickPov'} / 100;
$Val = $Min;
if ( $Pov == $Angle )
{
$Val = $Max;
}
}
# Mouse Button
elsif ( $Control =~ /^MouseButton(\d+)/i )
{
my $Button = $1 - 1;
$Val = $Min;
if ( &MouseButton($Button) )
{
$Val = $Max;
}
}
# Serial Channel
elsif ( $Control =~ /^SerialChannel/i )
{
$Val = $MkSerialChannel{$Control};
}
# fixed value
elsif ( $Control =~ /^(-*\d+)/i )
{
$Val = $1;
}
# analog stick
else
{
# Scale Stick 0..StickRange to -125..0..125
$Val = $Stick{$Control} / $Stick{'StickRange'} * 250 - 125;
if ( $Reverse =~ /Reverse/i )
{
$Val = - $Val;
}
}
# Expo/Limit for each input control
if ( "ExternControlGas ExternControlHeight" =~ /$Channel/ )
{
$Val += 125; # -125..0..125 -> 0..250
$Val = &ExpoLimit (0, 250, $Val, $ControlExpo, $ControlLimit);
}
else
{
# all other symmetrical channels -125..0..125
$Val = &ExpoLimit (-125, 125, $Val, $ControlExpo, $ControlLimit);
}
$ChannelVal += $Val;
}
}
# Expo/Limit for output channel
if ( "ExternControlGas ExternControlHeight" =~ /$Channel/ )
{
# asymmetrical channels 0..250
$ChannelVal = &ExpoLimit (0, 255, $ChannelVal, $Expo, $Limit);
$ChannelVal = int ($ChannelVal + 0.5);
$ChannelVal = &CheckUnsignedChar($ChannelVal);
}
else
{
# all other symmetrical channels -125..0..125
$ChannelVal = &ExpoLimit (-125, 125, $ChannelVal, $Expo, $Limit);
$ChannelVal = int ($ChannelVal + 0.5);
$ChannelVal = &CheckSignedChar($ChannelVal);
}
return $ChannelVal;
}
#
# Send Serial Channel + stick button/analog handling
#
my $SerialChannelTiming = $Cfg->{'serialchannel'}->{'SerialChannelFrquency'} || 20;
$SerialChannelTiming = int (1 / $SerialChannelTiming * 1000);
if ( $SerialChannelTiming < 10 )
{
$SerialChannelTiming = 10;
}
# Timer: variable timing
$frame_map_top->repeat ($SerialChannelTiming, sub
{
# 12 serial Channel
for ( my $ChannelInd = 0; $ChannelInd < 12; $ChannelInd ++)
{
my $Channel = sprintf ("SerialChannel%02d", $ChannelInd + 1); # key for Cfg-hash
my $Control = $Cfg->{'serialchannel'}->{$Channel};
if ( $Control ne "" )
{
my $Expo = $Cfg->{'serialchannel'}->{$Channel . "Expo"};
my $Limit = $Cfg->{'serialchannel'}->{$Channel . "Limit"};
my $ChannelVal = &ParseControls($Channel, $Control, $Expo, $Limit);
&SerialChannel($ChannelInd, $ChannelVal);
}
}
$MkSerialChannel{'SerialChannelSend'} = $Cfg->{'serialchannel'}->{'SerialChannelSend'};
$MkSerialChannel{'SerialChannelTiming'} = $SerialChannelTiming;
# send serial Channel to MK, nicht wenn deaktiviert oder WP uebertragen werden
if ( ! $MkSendWp and $Cfg->{'serialchannel'}->{'SerialChannelSend'} =~ /y/i and $TxExtOn == 1)
{
&SendSerialChannel(); # send values in %MkSerialChannel
}
});
#
# Extern Control
#
my $ExternControlTiming = $Cfg->{'externcontrol'}->{'ExternControlFrquency'} || 20;
$ExternControlTiming = int (1 / $ExternControlTiming * 1000);
if ( $ExternControlTiming < 10 )
{
$ExternControlTiming = 10;
}
# Timer: variable timing
$frame_map_top->repeat ($ExternControlTiming, sub
{
foreach my $Channel ( qw(ExternControlRoll ExternControlNick ExternControlGier ExternControlGas ExternControlHeight) )
{
my $Control = $Cfg->{'externcontrol'}->{$Channel};
if ( $Control ne "" )
{
my $Expo = $Cfg->{'externcontrol'}->{$Channel . "Expo"};
my $Limit = $Cfg->{'externcontrol'}->{$Channel . "Limit"};
$MkExternControl{$Channel} = &ParseControls($Channel, $Control, $Expo, $Limit);
}
}
$MkExternControl{'ExternControlSend'} = $Cfg->{'externcontrol'}->{'ExternControlSend'};
$MkExternControl{'ExternControlTimimg'} = $ExternControlTiming;
# send extern control to MK, nicht wenn deaktiviert oder WP uebertragen werden
if ( ! $MkSendWp and $Cfg->{'externcontrol'}->{'ExternControlSend'} =~ /y/i and $TxExtOn == 1 )
{
&SendExternalControl ( '-nick' => $MkExternControl{'ExternControlNick'},
'-roll' => $MkExternControl{'ExternControlRoll'},
'-gier' => $MkExternControl{'ExternControlGier'},
'-gas' => $MkExternControl{'ExternControlGas'},
'-height' => $MkExternControl{'ExternControlHeight'},
'-remotebuttons' => 0,
'-config' => 1,
'-frame' => 1,
);
$MkExternControl{'_Timestamp'} = time; # time when command was sent
}
});
#
# mouse/joystick crosshair move in player pause mode
#
$frame_map_top->repeat (50, sub # 50ms
{
if ( $PlayerMode eq 'Pause' and
$PlayerPause_Lat ne "" and $PlayerPause_Lon ne "" )
{
if ( $Stick{'_JoystickTimestamp'} >= time-1 or $Stick{'_MouseTimestamp'} >= time-2 )
{
lock (%MkOsd); # until end of block
my $ControlX = $Cfg->{'map'}->{'CrosshairMoveX'};
my $ControlY = $Cfg->{'map'}->{'CrosshairMoveY'};
if ( $ControlX ne "" and $ControlY ne "" )
{
my $StickRange = 250;
my $Bias = $StickRange /2;
my $ExpoX = $Cfg->{'map'}->{'CrosshairMoveXExpo'};
my $LimitX = $Cfg->{'map'}->{'CrosshairMoveXLimit'};
my $SpeedX = &ParseControls('CrosshairMoveX', $ControlX, $ExpoX, $LimitX);
my $ExpoY = $Cfg->{'map'}->{'CrosshairMoveYExpo'};
my $LimitY = $Cfg->{'map'}->{'CrosshairMoveYLimit'};
my $SpeedY = &ParseControls('CrosshairMoveY', $ControlY, $ExpoY, $LimitY);
my $BearingTop = &MapAngel() - 90.0;
my $BearingMouse = rad2deg atan2($SpeedX, $SpeedY);
my $Bearing = $BearingTop + $BearingMouse;
if ( $PlayerPauseMode eq "MK" )
{
# MK Reference
$Bearing = $MkOsd{'CompassHeading'} + $BearingMouse;
}
# max. 30m/s at 50ms frame time
my $Speed = sqrt ($SpeedX * $SpeedX + $SpeedY * $SpeedY);
my $Dist = 40*50/1000 * $Speed / $Bias;
($PlayerPause_Lat, $PlayerPause_Lon) = &MapGpsAt($PlayerPause_Lat, $PlayerPause_Lon, $Dist, $Bearing);
if ( $SpeedX != 0 or $SpeedY != 0 )
{
$CrosshairTimerCnt = 0;
}
}
}
#
# show/update Crosshair for 5 sec after move
#
if ( $CrosshairTimerCnt < 5 * 1000/50)
{
&CrosshairShow ($PlayerPause_Lat, $PlayerPause_Lon);
}
elsif ( $CrosshairTimerCnt == 5 * 1000/50)
{
&CrosshairHide();
}
$CrosshairTimerCnt ++;
}
});
__END__

/MissionCockpit/tags/V0.4.0/libmouse.pl
0,0 → 1,133
#!/usr/bin/perl
#!/usr/bin/perl -d:ptkdb
###############################################################################
#
# libmouse.pl - 3D Mouse Space Navigator
#
# Copyright (C) 2009 Rainer Walther (rainerwalther-mail@web.de)
#
# Creative Commons Lizenz mit den Zusaetzen (by, nc, sa)
#
# Es ist Ihnen gestattet:
# * das Werk vervielfältigen, verbreiten und öffentlich zugänglich machen
# * Abwandlungen bzw. Bearbeitungen des Inhaltes anfertigen
#
# Zu den folgenden Bedingungen:
# * Namensnennung.
# Sie müssen den Namen des Autors/Rechteinhabers in der von ihm festgelegten Weise nennen.
# * Keine kommerzielle Nutzung.
# Dieses Werk darf nicht für kommerzielle Zwecke verwendet werden.
# * Weitergabe unter gleichen Bedingungen.
# Wenn Sie den lizenzierten Inhalt bearbeiten oder in anderer Weise umgestalten,
# verändern oder als Grundlage für einen anderen Inhalt verwenden,
# dürfen Sie den neu entstandenen Inhalt nur unter Verwendung von Lizenzbedingungen
# weitergeben, die mit denen dieses Lizenzvertrages identisch oder vergleichbar sind.
#
# Im Falle einer Verbreitung müssen Sie anderen die Lizenzbedingungen, unter welche dieses
# Werk fällt, mitteilen. Am Einfachsten ist es, einen Link auf diese Seite einzubinden.
#
# Jede der vorgenannten Bedingungen kann aufgehoben werden, sofern Sie die Einwilligung
# des Rechteinhabers dazu erhalten.
#
# Diese Lizenz lässt die Urheberpersönlichkeitsrechte unberührt.
#
# Weitere Details zur Lizenzbestimmung gibt es hier:
# Kurzform: http://creativecommons.org/licenses/by-nc-sa/3.0/de/
# Komplett: http://creativecommons.org/licenses/by-nc-sa/3.0/de/legalcode
#
###############################################################################
#
# 2009-12-09 0.0.1 rw created
#
###############################################################################
$Version{'libmouse.pl'} = "0.0.1 - 2009-12-09";
# Packages
use threads; # http://search.cpan.org/~jdhedden/threads-1.72/threads.pm
# http://perldoc.perl.org/threads.html
use threads::shared; # http://search.cpan.org/~jdhedden/threads-shared-1.28/shared.pm
# Hashes exported to other threads and main-program
share (%Stick);
my $StickRange = 1024; # global stick range
my $Bias = $StickRange/2;
my $ResMouse = 1000; # +-500
my $MousePrg = "bin/3DMouse.exe";
sub Mouse3D()
{
if ( ! -f $MousePrg )
{
return;
}
$Stick{'StickRange'} = $StickRange;
$Stick{'MouseRotX'} = $Bias;
$Stick{'MouseRotY'} = $Bias;
$Stick{'MouseRotZ'} = $Bias;
$Stick{'MouseTranX'} = $Bias;
$Stick{'MouseTranY'} = $Bias;
$Stick{'MouseTranZ'} = $Bias;
$Stick{'MouseButton'} = 0;
$Stick{'_MouseTimestamp'} = time;
$Stick{'_MousePid'} = open (my $fh, "$MousePrg |");
while (my $Line = <$fh> )
{
if ( $Line =~ /Device 0: DOF: T: (\S*)\s*(\S*)\s*(\S*) R: (\S*)\s*(\S*)\s*(\S*)/g )
{
$TranslateX= $1;
$TranslateY= $2;
$TranslateZ= $3;
$RotateX= $4;
$RotateY= $5;
$RotateZ= $6;
lock (%Stick); # until end of block
$Stick{'MouseRotX'} = $Bias - int ($RotateY / $ResMouse * $StickRange);
$Stick{'MouseRotY'} = $Bias - int ($RotateX / $ResMouse * $StickRange);
$Stick{'MouseRotZ'} = $Bias + int ($RotateZ / $ResMouse * $StickRange);
$Stick{'MouseTranX'} = $Bias + int ($TranslateX / $ResMouse * $StickRange);
$Stick{'MouseTranY'} = $Bias - int ($TranslateY / $ResMouse * $StickRange);
$Stick{'MouseTranZ'} = $Bias + int ($TranslateZ / $ResMouse * $StickRange);
$Stick{'_MouseTimestamp'} = time;
}
elsif ( $Line =~ /Device 0: Button mask: (\S*)/g )
{
$Button = $1;
lock (%Stick); # until end of block
$Stick{'MouseButton'} = sprintf ("%d", $Button);
$Stick{'_MouseTimestamp'} = time;
}
}
}
# Kill Mouse3D Proceess
sub Mouse3DStop()
{
my $MousePid = $Stick{'_MousePid'};
if ( $MousePid ne "" )
{
kill -9, $MousePid;
}
}
# check, if button "Num" pressed, Num = 0 .. n
sub MouseButton()
{
my ($Num) = @_;
return (($Stick{'MouseButton'} >> $Num) & 1) == 1;
}
1;
__END__

/MissionCockpit/tags/V0.4.0/logging.pl
0,0 → 1,426
#!/usr/bin/perl
#!/usr/bin/perl -d:ptkdb
###############################################################################
#
# logging.pl - CSV, KLM, GPS Logging
#
# Copyright (C) 2009 Rainer Walther (rainerwalther-mail@web.de)
#
# Creative Commons Lizenz mit den Zusaetzen (by, nc, sa)
#
# Es ist Ihnen gestattet:
# * das Werk vervielfältigen, verbreiten und öffentlich zugänglich machen
# * Abwandlungen bzw. Bearbeitungen des Inhaltes anfertigen
#
# Zu den folgenden Bedingungen:
# * Namensnennung.
# Sie müssen den Namen des Autors/Rechteinhabers in der von ihm festgelegten Weise nennen.
# * Keine kommerzielle Nutzung.
# Dieses Werk darf nicht für kommerzielle Zwecke verwendet werden.
# * Weitergabe unter gleichen Bedingungen.
# Wenn Sie den lizenzierten Inhalt bearbeiten oder in anderer Weise umgestalten,
# verändern oder als Grundlage für einen anderen Inhalt verwenden,
# dürfen Sie den neu entstandenen Inhalt nur unter Verwendung von Lizenzbedingungen
# weitergeben, die mit denen dieses Lizenzvertrages identisch oder vergleichbar sind.
#
# Im Falle einer Verbreitung müssen Sie anderen die Lizenzbedingungen, unter welche dieses
# Werk fällt, mitteilen. Am Einfachsten ist es, einen Link auf diese Seite einzubinden.
#
# Jede der vorgenannten Bedingungen kann aufgehoben werden, sofern Sie die Einwilligung
# des Rechteinhabers dazu erhalten.
#
# Diese Lizenz lässt die Urheberpersönlichkeitsrechte unberührt.
#
# Weitere Details zur Lizenzbestimmung gibt es hier:
# Kurzform: http://creativecommons.org/licenses/by-nc-sa/3.0/de/
# Komplett: http://creativecommons.org/licenses/by-nc-sa/3.0/de/legalcode
#
###############################################################################
#
# 2009-02-23 0.0.1 rw created
# 2009-04-01 0.1.0 rw RC1
# 2009-05-01 0.1.1 rw configurable logging interval
# 2009-05-17 0.1.7 rw _Timestamp timeout von 2s auf 10s erhoeht
# 2009-09-30 0.1.8 rw SignalHandler removed
# 2010-01-23 0.1.9 rw kosmetics
# no logging, if simulator is active
#
###############################################################################
$Version{'logging.pl'} = "0.1.9 - 2010-01-23";
#
# Parameter
#
my $LoopTime = $Cfg->{'logging'}->{'Intervall'} || 1; # in s
$LoopTime *= 1000000; # in us
# Packages
use threads; # http://search.cpan.org/~jdhedden/threads-1.72/threads.pm
# http://perldoc.perl.org/threads.html
use threads::shared; # http://search.cpan.org/~jdhedden/threads-shared-1.28/shared.pm
use Thread::Queue; # http://search.cpan.org/dist/Thread-Queue-2.11/lib/Thread/Queue.pm
use Time::HiRes qw(usleep);
require "mkcomm.pl"; # MK communication
require "geserver.pl"; # Google Earth Server
require "translate.pl"; # Übersetzungstable
# Queue for receiving commands
$LogQueue = Thread::Queue->new();
my $LogState = "LOG"; # LOG, OFF
my $LogCsvIsOpen = 0;
my $LogKmlIsOpen = 0;
my $LogGpxIsOpen = 0;
my $GeServerIsRunning = 0;
#
# CSV
#
# Open CSV logfile
sub LogCsvOpen()
{
if ( ! $LogCsvIsOpen )
{
my ($sec,$min,$hour,$mday,$mon,$year,$wday,$yday,$isdst) = localtime(time);
my $Filename = sprintf ("mk-%04d%02d%02d-%02d%02d%02d.csv", $year+1900, $mon+1, $mday, $hour, $min, $sec);
open LOGCSV, ">$Cfg->{'logging'}->{'CsvLogDir'}/$Filename";
$LogCsvIsOpen = 1;
# print labes at first line
# NC OSD
my $Sep = "";
foreach $Label (sort keys %MkOsd)
{
if ( $Translate{$Label} ne "" )
{
$Label = $Translate{$Label};
}
print LOGCSV "$Sep" . "$Label";
$Sep = ",";
}
# NC Debug
foreach $Label (sort keys %MkNcDebug)
{
if ( $Translate{$Label} ne "" )
{
$Label = $Translate{$Label};
}
print LOGCSV "$Sep" . "$Label";
}
print LOGCSV "\n";
}
return 0;
}
# Close CSV
sub LogCsvClose()
{
if ( $LogCsvIsOpen )
{
close LOGCSV;
$LogCsvIsOpen = 0;
}
return 0;
}
# Log CSV
sub LogCsv()
{
lock %MkOsd; # until end of Block
lock %MkNcDebug; # until end of Block
if ( $MkOsd{'_Timestamp'} >= time-10 )
{
# active connection to MK
&LogCsvOpen();
# NC OSD
my $Sep = "";
foreach $Label (sort keys %MkOsd)
{
print LOGCSV "$Sep" . "$MkOsd{$Label}";
$Sep = ",";
}
# NC Debug
foreach $Label (sort keys %MkNcDebug)
{
print LOGCSV "$Sep" . "$MkNcDebug{$Label}";
}
print LOGCSV "\n";
}
else
{
# connection to MK lost, close Logfile
&LogCsvClose();
}
return 0;
}
#
# GPX
# http://www.topografix.com/gpx_manual.asp
#
# Open GPX logfile
sub LogGpxOpen()
{
if ( ! $LogGpxIsOpen )
{
my ($sec,$min,$hour,$mday,$mon,$year,$wday,$yday,$isdst) = localtime(time);
my $TimeStamp = sprintf ("%04d%02d%02d-%02d%02d%02d", $year+1900, $mon+1, $mday, $hour, $min, $sec);
my $Filename = "mk-" . $TimeStamp . ".gpx";
open LOGGPX, ">$Cfg->{'logging'}->{'GpxLogDir'}/$Filename";
$LogGpxIsOpen = 1;
my ($sec,$min,$hour,$mday,$mon,$year,$wday,$yday,$isdst) = gmtime(time);
my $UtcTimeStamp = sprintf ("%04d-%02d-%02dT%02d:%02d:%02dZ", $year+1900, $mon+1, $mday, $hour, $min, $sec);
# print GPX-Header
print LOGGPX <<EOF;
<?xml version="1.0" encoding="UTF-8"?>
<gpx
version="1.0"
creator="MK Mission Cockpit"
xmlns:xsi="http://www.w3.org/2001/XMLSchema-instance"
xmlns="http://www.topografix.com/GPX/1/0"
xsi:schemaLocation="http://www.topografix.com/GPX/1/0 http://www.topografix.com/GPX/1/0/gpx.xsd">
<time>${UtcTimeStamp}</time>
<trk>
<name>Mission Cockpit GPS logging</name>
<desc>Flight ${TimeStamp}</desc>
<trkseg>
EOF
}
return 0;
}
# Close GPX
sub LogGpxClose()
{
if ( $LogGpxIsOpen )
{
# print GPX-Trailer
print LOGGPX <<EOF;
</trkseg>
</trk>
</gpx>
EOF
close LOGGPX;
$LogGpxIsOpen = 0;
}
return 0;
}
# Log GPX
sub LogGpx()
{
lock %MkOsd; # until end of Block
if ( $MkOsd{'_Timestamp'} >= time-10 and
$MkOsd{'MKFlags'} & 0x02 and $MkOsd{'CurPos_Stat'} == 1 )
{
# active connection to MK, MK is flying, valid GPS
&LogGpxOpen();
my ($sec,$min,$hour,$mday,$mon,$year,$wday,$yday,$isdst) = gmtime(time);
my $UtcTimeStamp = sprintf ("%04d-%02d-%02dT%02d:%02d:%02dZ", $year+1900, $mon+1, $mday, $hour, $min, $sec);
my $Speed = $MkOsd{'GroundSpeed'} / 100; # m/s
my $Elevation = &Altitude();
printf LOGGPX <<EOF;
<trkpt lat="$MkOsd{'CurPos_Lat'}" lon="$MkOsd{'CurPos_Lon'}">
<ele>$Elevation</ele>
<time>${UtcTimeStamp}</time>
<sat>$MkOsd{'SatsInUse'}</sat>
<course>$MkOsd{'CompassHeading'}</course>
<speed>$Speed</speed>
<extensions>
<Target-Lat>$MkOsd{'TargetPos_Lat'}</Target-Lat>
<Target-Lon>$MkOsd{'TargetPos_Lon'}</Target-Lon>
<Target-Alt>$MkOsd{'TargetPos_Alt'}</Target-Alt>
<Target-Bearing>$MkOsd{'TargetPosDev_Bearing'}</Target-Bearing>
<Target-Dist>$MkOsd{'TargetPosDev_Dist'}</Target-Dist>
<Waypoint>$MkOsd{'WaypointIndex'} / $MkOsd{'WaypointNumber'}</Waypoint>
<Altimeter>$MkOsd{'Altimeter'}</Altimeter>
<Variometer>$MkOsd{'Variometer'}</Variometer>
<UBat>$MkOsd{'UBat'}</UBat>
<AngleNick>$MkOsd{'AngleNick'}</AngleNick>
<AngleRoll>$MkOsd{'AngleRoll'}</AngleRoll>
<MKFlags>$MkOsd{'MKFlags'}</MKFlags>
<NCFlags>$MkOsd{'NCFlags'}</NCFlags>
</extensions>
</trkpt>
EOF
}
else
{
&LogGpxClose();
}
}
#
# KML
# http://code.google.com/intl/de-DE/apis/kml/documentation/kml_tut.html
#
# Open KML logfile
sub LogKmlOpen()
{
if ( ! $LogKmlIsOpen )
{
my ($sec,$min,$hour,$mday,$mon,$year,$wday,$yday,$isdst) = localtime(time);
my $TimeStamp = sprintf ("%04d%02d%02d-%02d%02d%02d", $year+1900, $mon+1, $mday, $hour, $min, $sec);
my $Filename = "mk-" . $TimeStamp . ".kml";
open LOGKML, ">$Cfg->{'logging'}->{'KmlLogDir'}/$Filename";
$LogKmlIsOpen = 1;
# print KML-Header
print LOGKML <<EOF;
<?xml version="1.0" encoding="UTF-8"?>
<kml xmlns="http://earth.google.com/kml/2.2">
<Document>
<name>Mission Cockpit GPS logging</name>
<Style id="MK_gps-style">
<LineStyle>
<color>ff0000ff</color>
<width>2</width>
</LineStyle>
</Style>
<Placemark>
<name>Flight ${TimeStamp}</name>
<styleUrl>MK_gps-style</styleUrl>
<LineString>
<tessellate>1</tessellate>
<altitudeMode>relativeToGround</altitudeMode>
<coordinates>
EOF
}
return 0;
}
# Close KML
sub LogKmlClose()
{
if ( $LogKmlIsOpen )
{
# print KML-Trailer
print LOGKML <<EOF;
</coordinates>
</LineString>
</Placemark>
</Document>
</kml>
EOF
close LOGKML;
$LogKmlIsOpen = 0;
}
return 0;
}
# Log KML
sub LogKml()
{
lock %MkOsd; # until end of Block
if ( $MkOsd{'_Timestamp'} >= time-10 and
$MkOsd{'MKFlags'} & 0x02 and $MkOsd{'CurPos_Stat'} == 1 )
{
# active connection to MK, MK is flying, valid GPS
&LogKmlOpen();
my $Alt = &Altitude();
if ( $Alt < 0 ) { $Alt = 0; }
printf LOGKML " %f, %f, %f\n", $MkOsd{'CurPos_Lon'}, $MkOsd{'CurPos_Lat'}, $Alt;
}
else
{
&LogKmlClose();
}
}
# Send Coords to GoogleEarth server
sub Send2GeServer()
{
lock %MkOsd; # until end of Block
if ( $MkOsd{'_Timestamp'} >= time-10 and
$MkOsd{'MKFlags'} & 0x02 and $MkOsd{'CurPos_Stat'} == 1 )
{
# active connection to MK, MK is flying, valid GPS
my $AltRel = $MkOsd{'CurPos_Alt'} - $MkOsd{'HomePos_Alt'};
if ( $AltRel < 0 ) { $AltRel = 0; }
push @GeCoords, sprintf "%f, %f, %f", $MkOsd{'CurPos_Lon'}, $MkOsd{'CurPos_Lat'}, $AltRel;
}
}
sub MkLogLoop()
{
while (1)
{
# check commnd queue
if ( $LogQueue->pending() > 0 )
{
$LogState = $LogQueue->dequeue(1);
}
if ( $LogState eq "LOG" )
{
&LogCsv();
&LogKml();
&LogGpx();
}
&Send2GeServer(); # Google Earth
# kurz schlafen legen
usleep $LoopTime;
}
}
#
# Hauptprgramm
#
if ( $0 =~ /logging.pl$/i )
{
# Program wurde direkt aufgerufen
# Kommunikation zum MK herstellen
$mk_thr = threads->create (\&MkCommLoop) -> detach();
&MkLogLoop();
# should never exit
}
1;
__END__

/MissionCockpit/tags/V0.4.0/map/default-800.gif
Cannot display: file marked as a binary type.
svn:mime-type = application/octet-stream
Property changes:
Added: svn:mime-type
+application/octet-stream
\ No newline at end of property

/MissionCockpit/tags/V0.4.0/map/hemhofen-800.gif
Cannot display: file marked as a binary type.
svn:mime-type = application/octet-stream
Property changes:
Added: svn:mime-type
+application/octet-stream
\ No newline at end of property

/MissionCockpit/tags/V0.4.0/map/hemhofen-example.xml
0,0 → 1,30
<mkcockpit-Maps>
<Hemhofen
Name="Hemhofen"
File="hemhofen-800.gif"
P1_x="66"
P1_y="62"
P2_x="778"
P2_y="488"
P1_Lat="49.685333"
P1_Lon="10.950134"
P2_Lat="49.682949"
P2_Lon="10.944580"
Border="555, 430,
516, 555,
258, 555,
100, 300,
580, 260,
530, 94,
627, 130,
735, 300,
680, 400,
757, 470,
720, 515,
575, 420,"
/>
</mkcockpit-Maps>

/MissionCockpit/tags/V0.4.0/map/map.pl
0,0 → 1,275
###############################################################################
#
# map.pl - Map definition
#
## Copyright (C) 2009 Rainer Walther (rainerwalther-mail@web.de)
#
# Creative Commons Lizenz mit den Zusaetzen (by, nc, sa)
#
# Es ist Ihnen gestattet:
# * das Werk vervielfältigen, verbreiten und öffentlich zugänglich machen
# * Abwandlungen bzw. Bearbeitungen des Inhaltes anfertigen
#
# Zu den folgenden Bedingungen:
# * Namensnennung.
# Sie müssen den Namen des Autors/Rechteinhabers in der von ihm festgelegten Weise nennen.
# * Keine kommerzielle Nutzung.
# Dieses Werk darf nicht für kommerzielle Zwecke verwendet werden.
# * Weitergabe unter gleichen Bedingungen.
# Wenn Sie den lizenzierten Inhalt bearbeiten oder in anderer Weise umgestalten,
# verändern oder als Grundlage für einen anderen Inhalt verwenden,
# dürfen Sie den neu entstandenen Inhalt nur unter Verwendung von Lizenzbedingungen
# weitergeben, die mit denen dieses Lizenzvertrages identisch oder vergleichbar sind.
#
# Im Falle einer Verbreitung müssen Sie anderen die Lizenzbedingungen, unter welche dieses
# Werk fällt, mitteilen. Am Einfachsten ist es, einen Link auf diese Seite einzubinden.
#
# Jede der vorgenannten Bedingungen kann aufgehoben werden, sofern Sie die Einwilligung
# des Rechteinhabers dazu erhalten.
#
# Diese Lizenz lässt die Urheberpersönlichkeitsrechte unberührt.
#
# Weitere Details zur Lizenzbestimmung gibt es hier:
# Kurzform: http://creativecommons.org/licenses/by-nc-sa/3.0/de/
# Komplett: http://creativecommons.org/licenses/by-nc-sa/3.0/de/legalcode
#
###############################################################################
##
# 2009-03-06 0.0.1 rw created
# 2009-04-01 0.1.0 rw RC1
# 2009-04-18 0.1.1 rw Select default map, if configured map does not exist
# 2009-07-22 0.1.2 rw Offset_x and Offset_y for adjustment of map calibration
# 2009-08-15 0.1.3 rw Tracking Antenne Home position added
# Player home position added
# Read map definition from XML file
# 2009-09-29 0.1.4 rw Read map definition from KML file (GE import)
# Allow Config lines in map definition file (like mkcockpit.xml)
#
###############################################################################
$Version{'map/map.pl'} = "0.1.4 - 2009-09-29";
use XML::Simple; # http://search.cpan.org/dist/XML-Simple-2.18/lib/XML/Simple.pm
%Maps =
(
Default => {
'Name' => "Default",
'File' => 'default-800.gif',
'P1_x' => '71', # calibration P1, P2
'P1_y' => '472',
'P2_x' => '500',
'P2_y' => '103',
'P1_Lat' => '48.856253',
'P1_Lon' => '2.3500000',
'P2_Lat' => '54.090153',
'P2_Lon' => '12.133249',
# 'Offset_x' => 5, # Optional Pixel offset MK to right
# 'Offset_y' => 5, # Optional pixel offset MK to top
# 'Home_Lat' => '54.090153', # Optional home position for player
# 'Home_Lon' => '12.133249', # Optional home position for player
# 'Poi_Lat' => '54.090153', # Optional POI position for player
# 'Poi_Lon' => '12.133249', # Optional POI position for player
# 'Track_Lat' => '49.685333', # Optional Tracking Antenna pos
# 'Track_Lon' => '10.950134', # Optional Tracking Antenna pos
# 'Track_Alt' => '500', # Optional Tracking Antenna altitude
# 'Track_Bearing' => 10, # Optional Tracking antenne direction
# 'Border' => [ 555, 430, # airfield border
# 516, 555,
# 258, 555,
# 100, 300,
# 580, 260,
# 530, 94,
# 627, 130,
# 735, 300,
# 680, 400,
# 757, 470,
# 720, 515,
# 575, 420,
# ],
},
);
#
# load additional Maps from XML files
#
my $MapDir = $Cfg->{'map'}->{'MapDir'} || "map";
if ( -d $MapDir )
{
opendir DIR, $MapDir;
my @Files = readdir DIR;
@Files = grep /\.xml$/, @Files;
closedir DIR;
foreach $Xml (@Files)
{
my $MapConfigFile = "$MapDir/$Xml";
if ( -f $MapConfigFile )
{
my $XmlMap = XMLin($MapConfigFile);
foreach $Location (keys %{$XmlMap})
{
foreach $Key (keys %{$XmlMap->{$Location}} )
{
my $Value = $XmlMap->{$Location}->{$Key};
if ( $Key =~ /Border/i )
{
$Value =~ s/\s//g;
my @Border = split ',', $Value;
@{$Maps{$Location}->{$Key}} = @Border;
}
else
{
$Maps{$Location}->{$Key} = $Value;
}
}
}
}
}
}
#
# load additional Maps from KML files
#
my $MapDir = $Cfg->{'map'}->{'MapDir'} || "map";
if ( -d $MapDir )
{
opendir DIR, $MapDir;
my @Files = readdir DIR;
@Files = grep /\.kml$/, @Files;
closedir DIR;
foreach $Kml (@Files)
{
my $MapConfigFile = "$MapDir/$Kml";
if ( -f $MapConfigFile )
{
my $KmlMap = XMLin($MapConfigFile);
my $Name = $KmlMap->{'Document'}->{'Folder'}->{'name'};
my $Desc = $KmlMap->{'Document'}->{'Folder'}->{'description'};
$Maps{$Name}->{'Name'} = $Name;
# Airfield Border
my $Border = "";
my $bBorder = 0;
# parse config lines
@DescLines = split '\n', $Desc;
foreach $Line (@DescLines)
{
if ( $bBorder )
{
# collect border lines
if ( $Line =~ /=/i )
{
# New keyword found. End of multi-line border config
$bBorder = 0;
}
else
{
$Border = "$Border" . "$Line";
}
}
if ( $Line =~ /\s*(\S*)\s*=\s*(.*)/i)
{
my $Key = $1;
my $Value = $2;
chomp $Value;
# search for border keyword
if ($Key =~ /border/i )
{
$Border = $Value;
$bBorder = 1;
}
else
{
$Maps{$Name}->{$Key} = $Value;
}
}
}
if ( $Border ne "" )
{
$Border =~ s/\s//g;
my @Border = split ',', $Border;
@{$Maps{$Name}->{'Border'}} = @Border;
}
# P1 calibration point
my $P1 = $KmlMap->{'Document'}->{'Folder'}->{'Placemark'}->{'P1'}->{'Point'}->{'coordinates'};
my $P1Desc = $KmlMap->{'Document'}->{'Folder'}->{'Placemark'}->{'P1'}->{'description'};
($Maps{$Name}->{'P1_Lon'}, $Maps{$Name}->{'P1_Lat'}) = split ',', $P1;
if ( $P1Desc =~ /\s*x\s*=\s*(\d*)/i) { $Maps{$Name}->{'P1_x'} = $1; } # x=nnn
if ( $P1Desc =~ /\s*y\s*=\s*(\d*)/i) { $Maps{$Name}->{'P1_y'} = $1; } # y=nnn
# P2 calibration point
my $P2 = $KmlMap->{'Document'}->{'Folder'}->{'Placemark'}->{'P2'}->{'Point'}->{'coordinates'};
my $P2Desc = $KmlMap->{'Document'}->{'Folder'}->{'Placemark'}->{'P2'}->{'description'};
($Maps{$Name}->{'P2_Lon'}, $Maps{$Name}->{'P2_Lat'}) = split ',', $P2;
if ( $P2Desc =~ /\s*x\s*=\s*(\d*)/i) { $Maps{$Name}->{'P2_x'} = $1; } # x=nnn
if ( $P2Desc =~ /\s*y\s*=\s*(\d*)/i) { $Maps{$Name}->{'P2_y'} = $1; } # y=nnn
# Home position
if ( $KmlMap->{'Document'}->{'Folder'}->{'Placemark'}->{'Home'}->{'visibility'} ne "0" )
{
my $Home = $KmlMap->{'Document'}->{'Folder'}->{'Placemark'}->{'Home'}->{'Point'}->{'coordinates'};
my $HomeDesc = $KmlMap->{'Document'}->{'Folder'}->{'Placemark'}->{'Home'}->{'description'};
($Maps{$Name}->{'Home_Lon'}, $Maps{$Name}->{'Home_Lat'}) = split ',', $Home;
}
# POI position
if ( $KmlMap->{'Document'}->{'Folder'}->{'Placemark'}->{'POI'}->{'visibility'} ne "0" )
{
my $Poi = $KmlMap->{'Document'}->{'Folder'}->{'Placemark'}->{'POI'}->{'Point'}->{'coordinates'};
my $PoiDesc = $KmlMap->{'Document'}->{'Folder'}->{'Placemark'}->{'POI'}->{'description'};
($Maps{$Name}->{'Poi_Lon'}, $Maps{$Name}->{'Poi_Lat'}) = split ',', $Poi;
}
# Antenna tracker position
if ( $KmlMap->{'Document'}->{'Folder'}->{'Placemark'}->{'Antenna'}->{'visibility'} ne "0" )
{
my $Track = $KmlMap->{'Document'}->{'Folder'}->{'Placemark'}->{'Antenna'}->{'Point'}->{'coordinates'};
my $TrackDesc = $KmlMap->{'Document'}->{'Folder'}->{'Placemark'}->{'Antenna'}->{'description'};
($Maps{$Name}->{'Track_Lon'}, $Maps{$Name}->{'Track_Lat'}) = split ',', $Track;
if ( $TrackDesc =~ /\s*Track_Alt\s*=\s*(\d*)/i) { $Maps{$Name}->{'Track_Alt'} = $1; } # Track_Alt=nnn
if ( $TrackDesc =~ /\s*Track_Bearing\s*=\s*(\d*)/i) { $Maps{$Name}->{'Track_Bearing'} = $1; } # Track_Bearing=nnn
}
}
}
}
#
# Die verwendete Karte
#
my $MapDefault = $Cfg->{'map'}->{'MapDefault'};
if ( defined $Maps{$MapDefault} )
{
$Maps{'Current'} = $Maps{$MapDefault};
}
else
{
$Maps{'Current'} = $Maps{'Default'};
print "Map \"$MapDefault\" not found in map.pl. Using \"Default\" map\n";
}
#
# Todo: Karte automatisch anhand der aktuellen GPS Position auswählen
#
1;
__END__

/MissionCockpit/tags/V0.4.0/mkcockpit.pl
0,0 → 1,1714
#!/usr/bin/perl
#!/usr/bin/perl -d:ptkdb
###############################################################################
#
# mkcockpit.pl - MK Mission Cockpit - GUI
#
# Copyright (C) 2009 Rainer Walther (rainerwalther-mail@web.de)
#
# Creative Commons Lizenz mit den Zusaetzen (by, nc, sa)
#
# Es ist Ihnen gestattet:
# * das Werk vervielfältigen, verbreiten und öffentlich zugänglich machen
# * Abwandlungen bzw. Bearbeitungen des Inhaltes anfertigen
#
# Zu den folgenden Bedingungen:
# * Namensnennung.
# Sie müssen den Namen des Autors/Rechteinhabers in der von ihm festgelegten Weise nennen.
# * Keine kommerzielle Nutzung.
# Dieses Werk darf nicht für kommerzielle Zwecke verwendet werden.
# * Weitergabe unter gleichen Bedingungen.
# Wenn Sie den lizenzierten Inhalt bearbeiten oder in anderer Weise umgestalten,
# verändern oder als Grundlage für einen anderen Inhalt verwenden,
# dürfen Sie den neu entstandenen Inhalt nur unter Verwendung von Lizenzbedingungen
# weitergeben, die mit denen dieses Lizenzvertrages identisch oder vergleichbar sind.
#
# Im Falle einer Verbreitung müssen Sie anderen die Lizenzbedingungen, unter welche dieses
# Werk fällt, mitteilen. Am Einfachsten ist es, einen Link auf diese Seite einzubinden.
#
# Jede der vorgenannten Bedingungen kann aufgehoben werden, sofern Sie die Einwilligung
# des Rechteinhabers dazu erhalten.
#
# Diese Lizenz lässt die Urheberpersönlichkeitsrechte unberührt.
#
# Weitere Details zur Lizenzbestimmung gibt es hier:
# Kurzform: http://creativecommons.org/licenses/by-nc-sa/3.0/de/
# Komplett: http://creativecommons.org/licenses/by-nc-sa/3.0/de/legalcode
#
###############################################################################
# 2009-02-20 0.0.1 rw created
# 2009-04-01 0.1.0 rw RC1
# 2009-04-16 0.1.1 rw Bugfix, ALT= average of airsensor and Sat
# 2009-05-14 0.2.0 rw Waypoint Player
# 2009-05-17 0.2.1 rw Cursor-Steuerung fuer WP-Player. Cmdline-Parameter "-geometry"
# 2009-07-18 0.2.2 rw DE/EN multinational
# Target-Balloon with Distance, Tolerance and Holdtime
# Fix footprint "Ausreiser"
# JPEG and PNG maps supported
# Player for KML Files
# 2009-07-26 0.2.3 rw System Messages Balloon
# 2009-07-31 0.2.4 rw ODO Kilometerzähler
# Enter WP-Number from Keyboard
# Random WP-Player (Waypoint and Map)
# Check Airfield Border
# Draw Calibration points on map
# 2009-08-08 0.2.5 rw KML Recorder
# Text to speech
# Subroutines moved to libmkcockpit.pl
# Timer moved to libmktimer.pl
# Start Scenarion configuration
# Battery capacity estimation
# Read map definition from maps/map.xml
# 2009-08-23 0.2.6 rw Tracking-Antenna Icon
# Show Fox only in Player-Pause mode
# POI heading control
# Display scale
# Measuring-tool on left mouse button
# Display Operation Radius Border
# Read map definition from KML file (GE import)
# Include of local *.pm changed
# Copy x/y/Lat/Lon to Clipboard when pressing left mouse button
# Calculate size of map image
# track.pl - Commandline parameter added for COM ports
# don't use local perl libs any more
# 2009-10-18 0.2.7 rw Mk-Simulator
# Start tracker at program start. Coldstart at MK-calibration
# COM Port >9; PortSetSkip config
# Reset Flight-Time and ODO when clicking on OSD-value
# 2009-10-25 0.3.0 rw NC 0.17
# Read/Write KopterTool WPL Waypoint list
# Cfg Optionmenues
# 2010-02-09 0.4.0 rw Canvas - Popup focus improvement
# bugfix "WP hinzufügen und senden" in classic mode
# Grid on canvas
# joystick and 3D-Mouse
# remove main window status line
# Event engine
# Serial Channel
# External Control
# Expo, Dualrate
# Player Pause move relative to MAP or MK
# Load plugin directory
# Current, UsedCapacity, Power added
# RETURN turns off External-Control + Serial Channel
#
###############################################################################
$Version = "0.4.0 - 2010-02-09";
# change working directory to program path
my $Cwd = substr ($0, 0, rindex ($0, "mkcockpit.pl"));
chdir $Cwd;
# set path for local Perl libs
push @INC, $Cwd . "perl/lib";
use threads; # http://search.cpan.org/~jdhedden/threads-1.72/threads.pm
# http://perldoc.perl.org/threads.html
use threads::shared; # http://search.cpan.org/~jdhedden/threads-shared-1.28/shared.pm
use Thread::Queue; # http://search.cpan.org/dist/Thread-Queue-2.11/lib/Thread/Queue.pm
use Tk;
use Tk::Balloon;
use Tk::Dialog;
use Tk::Notebook;
use Tk::JPEG; # http://search.cpan.org/~srezic/Tk-804.028/JPEG/JPEG.pm
use Tk::PNG; # http://search.cpan.org/~srezic/Tk-804.028/PNG/PNG.pm
use Tk::Tree;
use Math::Trig;
use Time::HiRes qw(usleep); # http://search.cpan.org/~jhi/Time-HiRes-1.9719/HiRes.pm
use XML::Simple; # http://search.cpan.org/dist/XML-Simple-2.18/lib/XML/Simple.pm
use Clipboard; # http://search.cpan.org/~king/Clipboard-0.09/lib/Clipboard.pm
use Image::Size; # http://search.cpan.org/~rjray/Image-Size-3.2/lib/Image/Size.pm
use Tk::BrowseEntry; # http://search.cpan.org/~srezic/Tk-804.028/pod/BrowseEntry.pod
# Version setting
share (%Version);
$Version{'mkcockpit.pl'} = $Version;
# Read configuration
$XmlConfigFile = "mkcockpit.xml";
$Cfg = XMLin($XmlConfigFile);
require "track.pl"; # Tracking antenna
require "mkcomm.pl"; # MK communication
require "logging.pl"; # CSV and GPX Logging
require "geserver.pl"; # Google Earth Server
require "$Cfg->{'map'}->{'MapDir'}/map.pl"; # Landkarte
require "libmap.pl"; # map subs
require "translate.pl"; # Übersetzungstable
require "tts.pl"; # Text to Speech
require "libmkcockpit.pl"; # Subroutines
require "libmksim.pl"; # MK Simulator
require "libcfgopt.pl"; # Option menu values
require "libmouse.pl"; # 3D Mouse
require "libjoystick.pl"; # joystick
# Commandline parameter
my %CmdLine = @ARGV;
# Aktuell gültige Karte
my %Map = %{$Maps{'Current'}};
# optional map specific Cfg setup from map definition
foreach $Key (keys %Map)
{
# Cfg:Section:Keyword
if ( $Key =~ /^Cfg:(\S*):(\S*)/i )
{
$Section = $1;
$Keyword = $2;
$Cfg->{$Section}->{$Keyword} = $Map{$Key};
}
}
# Canvas size - get image size
my $ImgFile = "$Cfg->{'map'}->{'MapDir'}/$Map{'File'}";
($MapSizeX, $MapSizeY, my $ImgError) = imgsize ($ImgFile);
if ( $MapSizeX eq "" )
{
print "$ImgFile: $ImgError\n";
# Try size information from map definition
$MapSizeX = $Map{'Size_X'};
$MapSizeY = $Map{'Size_Y'};
}
# Thread fuer Kommunikation mit MK starten
# Output: %MkOsd, %MkTarget, %MkNcDebug, %Mk
# Input: Thread-Queue: $MkSendQueue
$mk_thr = threads->create (\&MkCommLoop) -> detach();
# Start Logging Thread
$log_thr = threads->create (\&MkLogLoop) -> detach();
# Start GoogleEarth Thread
$ge_thr = threads->create (\&GeServer) -> detach();
# Start TTS Thread
$tts_thr = threads->create (\&TtsLoop) -> detach();
# Start Antenna tracker
if ( $Cfg->{'track'}->{'Active'} =~ /y/i )
{
$track_thr = threads->create (\&TrackAntennaGps)->detach();
}
# 3D Mouse Thread
$mouse_thr = threads->create (\&Mouse3D) -> detach();
# Joystick Thread
$joystick_thr = threads->create (\&Joystick) -> detach();
#
# Player:
# Waypoint-List: @Waypoints
# KML-Target-List: @KmlTargets
#
# Player state machine
$PlayerMode = 'Stop'; # Play, Stop, Pause, Home ...
$PlayerWptKmlMode = 'WPT'; # WPT, KML
$PlayerRandomMode = 'STD'; # STD, RND, MAP
$PlayerRecordMode = ""; # "", REC
$PlayerPauseMode = "MAP"; # MAP, MK
$WpPlayerIndex = 0;
$WpPlayerHoldtime = -1;
$KmlPlayerIndex = 0;
$PlayerPause_Lat = "";
$PlayerPause_Lon = "";
# Point Of Interest (POI)
my $Poi_x = $MapSizeX/2-50;
my $Poi_y = $MapSizeY/2 ;
($Poi_Lat, $Poi_Lon) = &MapXY2Gps($Poi_x + 24, $Poi_y + 48);
# POI from Map configuration
if ( $Map{'Poi_Lat'} ne "" and $Map{'Poi_Lon'} ne "" )
{
$Poi_Lat = $Map{'Poi_Lat'};
$Poi_Lon = $Map{'Poi_Lon'};
($Poi_x, $Poi_y) = &MapGps2XY($Poi_Lat, $Poi_Lon);
$Poi_x = $Poi_x - 24;
$Poi_y = $Poi_y - 48;
}
$Poi_Mode = 0; # POI Mode off
$TxExtOn = 0; # Tx External-Control/SerialChannel off
# Event configuration
my $XmlEventConfigFile = $Cfg->{'StartScenario'}->{'EventFile'} || "event/mkevent.xml";
if ( ! -f $XmlEventConfigFile )
{
$XmlEventConfigFile = "event/" . $XmlEventConfigFile;
}
if ( -f $XmlEventConfigFile )
{
$Event = XMLin($XmlEventConfigFile);
}
if ( scalar keys %{$Event} == 0 )
{
# create new dummy event, if no XML or XML is empty
&EventInit("Dummy", $Event);
}
my %EventStat; # internal state of event maschine
# load user plugins
opendir DIR, "plugin";
my @Plugin = readdir DIR;
closedir DIR;
@Plugin = grep /\.pl$/, @Plugin;
foreach my $File (@Plugin)
{
require "plugin/$File";
}
# Hauptfenster
$main = new MainWindow;
$main->title ("MK Mission Cockpit - Version $Version");
if ( $CmdLine{'-geometry'} ne "" )
{
$main->geometry( "$CmdLine{'-geometry'}" );
}
# pattern for dashed lines
my $stipple_bits = [];
foreach my $b (1..8)
{
push @$stipple_bits, pack ('b8', '1' x $b . '.' x (8 - $b));
$main->DefineBitmap("stipple$b" => 8, 1, $stipple_bits->[$b-1]);
}
# Catch delete window event and exit
$main->protocol( 'WM_DELETE_WINDOW' => sub
{
&CbExit();
});
#-----------------------------------------------------------------
# Menu
#-----------------------------------------------------------------
# Menu bar
my $menu_bar = $main->Menu;
$main->optionAdd("*tearOff", "false");
$main->configure ('-menu' => $menu_bar);
my $menu_file = $menu_bar->cascade('-label' => $Translate{'File'});
$menu_file->command('-label' => $Translate{'Preferences'},
'-command' => [\&Configure, $XmlConfigFile, $Cfg, "CONFIG", ],
);
$menu_file->command('-label' => $Translate{'ConfigEvent'},
'-command' => [\&Configure, $XmlEventConfigFile, $Event, "EVENT", ],
);
$menu_file->separator;
$menu_file->command('-label' => $Translate{'Exit'},
'-command' => [\&CbExit ],
);
my $menu_debug = $menu_bar->cascade(-label => $Translate{'Debug'});
$menu_debug->command('-label' => $Translate{'NcOsdDataset'},
'-command' => [\&DisplayHash, \%MkOsd, $Translate{'NcOsdDataset'}, "Display Refresh Heartbeat"],
);
$menu_debug->command('-label' => $Translate{'NcTargetDataset'},
'-command' => [\&DisplayHash, \%MkTarget, $Translate{'NcTargetDataset'}, "Display Refresh Heartbeat"],
);
$menu_debug->command('-label' => $Translate{'NcDebugDataset'},
'-command' => [\&DisplayHash, \%MkNcDebug, $Translate{'NcDebugDataset'}, "Display Refresh Heartbeat"],
);
$menu_debug->command('-label' => $Translate{'NcOther'},
'-command' => [\&DisplayHash, \%Mk, $Translate{'NcOther'}, "Display Refresh Heartbeat"],
);
$menu_debug->command('-label' => $Translate{'TrackingDebugDataset'},
'-command' => [\&DisplayHash, \%MkTrack, $Translate{'TrackingDebugDataset'}, "Display Refresh Heartbeat"],
);
$menu_debug->command('-label' => $Translate{'MapDebugDataset'},
'-command' => [\&DisplayHash, \%Map, $Translate{'MapDebugDataset'}, "Display"],
);
$menu_debug->command('-label' => $Translate{'SystemDebug'},
'-command' => [\&DisplayHash, \%System, $Translate{'SystemDebug'}, "Display Refresh"],
);
$menu_debug->separator;
$menu_debug->command('-label' => $Translate{'StickDebug'},
'-command' => [\&DisplayHash, \%Stick, $Translate{'StickDebug'}, "Display Refresh"],
);
$menu_debug->command('-label' => $Translate{'SerialChannel'},
'-command' => [\&DisplayHash, \%MkSerialChannel, $Translate{'SerialChannel'}, "Display Refresh SerialChannel"],
);
$menu_debug->command('-label' => $Translate{'ExternControl'},
'-command' => [\&DisplayHash, \%MkExternControl, $Translate{'ExternControl'}, "Display Refresh ExternControl"],
);
$menu_debug->separator;
$menu_debug->command('-label' => $Translate{'MkDebugSim'},
'-command' => \&MkSim,
);
my $menu_help = $menu_bar->cascade(-label => $Translate{'Help'});
$menu_help->command('-label' => 'Version',
'-command' => [\&DisplayHash, \%Version, $Translate{'Version'}, "Display"],
);
$menu_help->separator;
$menu_help->command('-label' => $Translate{'About'},
'-command' => sub
{
my $License = <<EOF;
Copyright (C) 2010 Rainer Walther (rainerwalther-mail\@web.de)
Creative Commons Lizenz mit den Zusaetzen (by, nc, sa)
See LICENSE.TXT
EOF
my $DlgAbout = $frame_map->Dialog('-title' => $Translate{'AboutMissionCockpit'},
'-text' => "$License",
'-buttons' => ['OK'],
'-bitmap' => 'info',
);
$DlgAbout->Show;
});
#-----------------------------------------------------------------
# Frames
#-----------------------------------------------------------------
#
# Frame: Map
#
$frame_map = $main->Frame( '-background' => 'lightgray',
'-relief' => 'sunken',
'-borderwidth' => 5,
) -> pack('-side' => 'top',
'-fill' => 'x',
);
# Map Überschrift
$frame_map_top = $frame_map->Frame( -background => 'lightgray',
) -> pack( -side => 'top',
-anchor => 'w',
-fill => 'x',
-expand => 1,
);
$frame_map_top->Label (-text => "$Translate{'Map'}: $Map{'Name'} ($Map{'File'})",
-background => 'lightgray',
-relief => 'flat',
) -> pack( -side => 'left' );
# 10 placeholders for status texts in uppser status line. Field update in libmktimer
for ($i=0; $i<10; $i++)
{
$map_status_top[$i] = $frame_map_top->Label ( -text => "",
-background => 'lightgray',
-anchor => 'e',
) -> pack (-side => 'right',
-anchor => 'e',
-padx => 1,
);
}
# Map Statuszeile
$map_status = $frame_map->Frame( -background => 'lightgray',
) -> pack( -side => 'bottom',
-anchor => 'w',
-fill => 'x',
-expand => 1,
);
$map_status_line = $map_status->Label ( -text => $Translate{'StatusLine'},
-background => 'lightgray',
) -> pack (-side => 'left',
-anchor => 'w',
-expand => 1,
);
# 10 placeholders for event status in lower status line. Field update in libmktimer
for ($i=0; $i<10; $i++)
{
$map_status_event[$i] = $map_status->Label ( -text => "",
-background => 'lightgray',
-anchor => 'e',
) -> pack (-side => 'right',
-anchor => 'e',
-padx => 1,
);
}
#
# Map Canvas
#
$map_canvas = $frame_map->Canvas( '-width' => $MapSizeX,
'-height' => $MapSizeY,
'-cursor' => 'cross',
) -> pack();
# Images and Icons on canvas
my @Icons = (
# Image Tag File Pos_x Pos_y
'Map', 'Map', "$Cfg->{'map'}->{'MapDir'}/$Map{'File'}", 0, 0,
'HeartbeatSmall', 'Heartbeat', "$Cfg->{'mkcockpit'}->{'IconHeartSmall'}", $MapSizeX/4-10, 10,
'HeartbeatLarge', 'Heartbeat', "$Cfg->{'mkcockpit'}->{'IconHeartLarge'}", $MapSizeX/4-10, -100,
'Satellite-Photo', 'Satellite', "$Cfg->{'mkcockpit'}->{'IconSatellite'}", $MapSizeX-50, -100,
'Antenna-Photo', 'Track-Antenna',"$Cfg->{'track'}->{'IconAntenna'}", 0, -50,
'POI-Photo', 'POI' ,"$Cfg->{'mkcockpit'}->{'IconPoi'}", $Poi_x, $Poi_y,
'Waypoint-Photo', 'Waypoint', "$Cfg->{'mkcockpit'}->{'IconWaypoint'}", 0, -150,
'Target-Photo', 'Target', "$Cfg->{'mkcockpit'}->{'IconTarget'}", 0, -100,
'Fox-Photo', 'Fox', "$Cfg->{'mkcockpit'}->{'IconFox'}", $MapSizeX/2-100, $MapSizeY/2,
'WpPlay-Foto', 'Wp-PlayPause', "$Cfg->{'waypoint'}->{'IconPlay'}", $MapSizeX/2+150, $MapSizeY-48,
'WpPause-Foto', 'Wp-PlayPause', "$Cfg->{'waypoint'}->{'IconPause'}", $MapSizeX/2+150, -100,
'WpStop-Foto', 'Wp-Stop', "$Cfg->{'waypoint'}->{'IconStop'}", $MapSizeX/2+200, $MapSizeY-48,
'WpNext-Foto', 'Wp-Next', "$Cfg->{'waypoint'}->{'IconNext'}", $MapSizeX/2+50, $MapSizeY-48,
'WpPrev-Foto', 'Wp-Prev', "$Cfg->{'waypoint'}->{'IconPrev'}", $MapSizeX/2, $MapSizeY-48,
'WpFirst-Foto', 'Wp-First', "$Cfg->{'waypoint'}->{'IconFirst'}", $MapSizeX/2-50, $MapSizeY-48,
'WpLast-Foto', 'Wp-Last', "$Cfg->{'waypoint'}->{'IconLast'}", $MapSizeX/2+100, $MapSizeY-48,
'WpHome-Foto', 'Wp-Home', "$Cfg->{'waypoint'}->{'IconHome'}", $MapSizeX/2-100, $MapSizeY-48,
'WpRecord-Foto', 'Wp-Record', "$Cfg->{'waypoint'}->{'IconRecord'}", $MapSizeX/2-150, $MapSizeY-48,
'WpRandomOff-Foto', 'Wp-WptRandom', "$Cfg->{'waypoint'}->{'IconRandomOff'}", $MapSizeX/2-200, -100,
'WpRandomOn-Foto', 'Wp-WptRandom', "$Cfg->{'waypoint'}->{'IconRandomOn'}", $MapSizeX/2-200, $MapSizeY-48,
'WpRandomMap-Foto', 'Wp-WptRandom', "$Cfg->{'waypoint'}->{'IconRandomMap'}", $MapSizeX/2-200, -100,
'WpWpt-Foto', 'Wp-WptKml', "$Cfg->{'waypoint'}->{'IconWpt'}", $MapSizeX/2-250, $MapSizeY-48,
'WpKml-Foto', 'Wp-WptKml', "$Cfg->{'waypoint'}->{'IconKml'}", $MapSizeX/2-250, -100 ,
);
my $i = 0;
for $Icon (0 .. $#Icons/5)
{
my $Image = $Icons[$i++];
my $Tag = $Icons[$i++];
my $File = $Icons[$i++];
my $Pos_x = $Icons[$i++];
my $Pos_y = $Icons[$i++];
$map_canvas->Photo( $Image,
-file => $File,
);
$map_canvas->createImage( $Pos_x, $Pos_y,
-tags => $Tag,
-anchor => 'nw',
-image => $Image,
);
}
# Calibration Points
$map_canvas->createLine ( $Map{'P1_x'}-8, $Map{'P1_y'},
$Map{'P1_x'}+8, $Map{'P1_y'},
$Map{'P1_x'}, $Map{'P1_y'},
$Map{'P1_x'}, $Map{'P1_y'}-8,
$Map{'P1_x'}, $Map{'P1_y'}+8,
'-tags' => 'Calibration',
'-arrow' => 'none',
'-fill' => 'red',
'-width' => 1,
);
$map_canvas->createLine ( $Map{'P2_x'}-8, $Map{'P2_y'},
$Map{'P2_x'}+8, $Map{'P2_y'},
$Map{'P2_x'}, $Map{'P2_y'},
$Map{'P2_x'}, $Map{'P2_y'}-8,
$Map{'P2_x'}, $Map{'P2_y'}+8,
'-tags' => 'Calibration',
'-arrow' => 'none',
'-fill' => 'red',
'-width' => 1,
);
# scale
my $x1 = $MapSizeX/2 +280;
my $x2 = $MapSizeX -30;
my $y1 = $MapSizeY - 20;
my $y2 = $MapSizeY - 15;
if ( $x2 - $x1 > 150 )
{
$x1 = $x2 - 150;
}
$map_canvas->createLine ( $x1, $y1,
$x1, $y2,
$x2, $y2,
$x2, $y1,
'-tags' => 'Scale',
'-arrow' => 'none',
'-fill' => 'red',
'-fill' => $Cfg->{'mkcockpit'}->{'ColorScale'} || 'white',
'-width' => 1,
);
my ($Lat1, $Lon1) = &MapXY2Gps($x1, $y1);
my ($Lat2, $Lon2) = &MapXY2Gps($x2, $y2);
my ($Dist, $Bearing) = &MapGpsTo($Lat1, $Lon1, $Lat2, $Lon2 );
$Dist = sprintf ("%.2f m", $Dist);
$map_canvas->createText ( $x1 + ($x2 - $x1)/2 - 20, $y1 - ($y2 - $y1)/2,
'-tags' => 'Scale-Text',
'-text' => $Dist,
'-anchor' => 'w',
'-font' => '-*-Arial-Bold-R-Normal--*-120-*',
'-fill' => $Cfg->{'mkcockpit'}->{'ColorScale'} || 'white',
);
# border polygon
$map_canvas->createPolygon( @Map{'Border'},
'-tags' => 'Map-Border',
'-fill' => '',
'-outline' => $Cfg->{'mkcockpit'}->{'ColorAirfield'}, '-width' => 2,
);
$map_canvas->raise('Map-Border', 'Map'); # Border above Map
# Balloon attached to Canvas
$map_balloon = $frame_map->Balloon('-statusbar' => $status_line, );
$map_balloon->attach($map_canvas,
'-balloonposition' => 'mouse',
'-state' => 'balloon',
'-msg' => { 'MK-Arrow' => $Translate{'Balloon-MK-Arrow'},
'MK-Home-Line' => $Translate{'Balloon-MK-Home-Line'},
'MK-Home-Dist' => $Translate{'Balloon-MK-Home-Dist'},
'MK-Target-Line' => $Translate{'Balloon-MK-Target-Line' },
'MK-Target-Dist' => $Translate{'Balloon-MK-Target-Dist'},
'MK-Speed' => $Translate{'Balloon-MK-Speed'},
'Map-Variometer' => $Translate{'Balloon-Map-Variometer' },
'Map-Variometer-Pointer' => $Translate{'Balloon-Map-Variometer-Pointer'},
'Map-Variometer-Skala' => $Translate{'Balloon-Map-Variometer-Pointer'},
'Fox' => $Translate{'Balloon-Fox'},
'Heartbeat' => $Translate{'Balloon-Heartbeat'},
'Satellite' => $Translate{'Balloon-Satellite'},
'Waypoint' => $Translate{'Balloon-Waypoint'},
'Map-Border' => $Translate{'Balloon-Map-Border'},
'Waypoint-Connector' => $Translate{'Balloon-Waypoint-Connector'},
'Wp-PlayPause' => $Translate{'Balloon-Wp-PlayPause'},
'Wp-Stop' => $Translate{'Balloon-Wp-Stop'},
'Wp-First' => $Translate{'Balloon-Wp-First'},
'Wp-Last' => $Translate{'Balloon-Wp-Last'},
'Wp-Next' => $Translate{'Balloon-Wp-Next'},
'Wp-Prev' => $Translate{'Balloon-Wp-Prev'},
'Wp-Home' => $Translate{'Balloon-Wp-Home'},
'Wp-WptKml' => $Translate{'Balloon-Wp-WptKml'},
'Wp-WptRandom' => $Translate{'Balloon-Wp-WptRandom'},
'Wp-Record' => $Translate{'Balloon-Wp-Record'},
'Track-Antenna' => $Translate{'Balloon-TrackAntenna'},
'POI' => $Translate{'Balloon-Poi'},
},
);
#
# Mouse button 1
#
# Button 1 Press
$map_canvas->CanvasBind("<Button-1>", sub
{
# print coords in status line
my ($x, $y) = ($Tk::event->x, $Tk::event->y);
my ($Lat, $Lon) = &MapXY2Gps($x, $y);
$map_status_line->configure ('-text' => "Lat: $Lat Lon: $Lon x: $x y: $y");
# save Coords and GPS-Pos for Button-Motion and Release
$Button1_x = $x;
$Button1_y = $y;
$Button1_Lat = $Lat;
$Button1_Lon = $Lon;
# copy Pixel-Coordinates to Clipboard
Clipboard->copy ("x=$x\r\n" . "y=$y\r\n" . "Lat=$Lat\r\n" . "Lon=$Lon\r\n");
});
# Button 1 Motion
$map_canvas->CanvasBind("<Button1-Motion>", sub
{
my ($x, $y) = ($Tk::event->x, $Tk::event->y);
my $id = $map_canvas->find('withtag', 'current');
# delete old measuring line
$map_canvas->delete('Map-Measure');
my @Tags = $map_canvas->gettags($id);
if ( ( $Tags[0] eq "Map" or $Tags[0] eq "Map-Border") and
$x ne $Button1_x and $y ne $Button1_y )
{
# button moved on Map
# draw new measuring line
$map_canvas->createLine ( $Button1_x, $Button1_y, $x, $y,
'-tags' => 'Map-Measure',
'-arrow' => 'none',
'-fill' => 'white',
'-width' => 1,
);
# update status line
my ($Lat, $Lon) = &MapXY2Gps($x, $y);
my ($Dist, $Bearing) = &MapGpsTo($Button1_Lat, $Button1_Lon, $Lat, $Lon);
$Dist = sprintf ("%.2f m", $Dist);
$Bearing = sprintf ("%.2f degree", $Bearing);
$map_status_line->configure ('-text' => "Dist: $Dist Bearing: $Bearing");
}
});
# Button 1 Release
$map_canvas->CanvasBind("<Button1-ButtonRelease>", sub
{
my ($x, $y) = ($Tk::event->x, $Tk::event->y);
my $id = $map_canvas->find('withtag', 'current');
# delete measuring line
$map_canvas->delete('Map-Measure');
my @Tags = $map_canvas->gettags($id);
if ( ( $Tags[0] eq "Map" or $Tags[0] eq "Map-Border") and
$x ne $Button1_x and $y ne $Button1_y )
{
# button released on Map
# update status line
my ($Lat, $Lon) = &MapXY2Gps($x, $y);
my ($Dist, $Bearing) = &MapGpsTo($Button1_Lat, $Button1_Lon, $Lat, $Lon);
$Dist = sprintf ("%.2f m", $Dist);
$Bearing = sprintf ("%.2f degree", $Bearing);
$map_status_line->configure ('-text' => "Dist: $Dist Bearing: $Bearing");
}
});
# Mouse button 1 for Fox
my $FoxOldx = 0;
my $FoxOldy = 0;
my $FoxTime = time;
&FoxHide(); # Show only in Player-Pause Mode
# Pick Fox
$map_canvas->bind('Fox' => '<Button-1>' => sub
{
# prepare to move Fox
my ($x, $y) = ($Tk::event->x, $Tk::event->y);
$FoxOldx = $x;
$FoxOldy = $y;
$FoxTime = time;
});
# Move Fox
$map_canvas->bind('Fox' => '<Button1-Motion>' => sub
{
my ($x, $y) = ($Tk::event->x, $Tk::event->y);
my $id = $map_canvas->find('withtag', 'current');
$map_canvas->move($id => $x - $FoxOldx, $y - $FoxOldy);
$FoxOldx = $x;
$FoxOldy = $y;
if ( time > $FoxTime )
{
# wenn in Bewegung Koordinaten nur 1/s senden
my ($x0, $y0, $x1, $y1) = $map_canvas->bbox ($id);
$x = $x0 + ($x1 - $x0)/2;
$y = $y1;
($PlayerPause_Lat, $PlayerPause_Lon) = &MapXY2Gps($x, $y);
$FoxTime = time;
$map_status_line->configure ('-text' => "$Translate{'TargetCoordSent'} -> Lat: $PlayerPause_Lat Lon: $PlayerPause_Lon x: $x y: $y");
}
});
# Release Fox
$map_canvas->bind('Fox' => '<Button1-ButtonRelease>' => sub
{
my ($x, $y) = ($Tk::event->x, $Tk::event->y);
my $id = $map_canvas->find('withtag', 'current');
my ($x0, $y0, $x1, $y1) = $map_canvas->bbox ($id);
$x = $x0 + ($x1 - $x0)/2;
$y = $y1;
($PlayerPause_Lat, $PlayerPause_Lon) = &MapXY2Gps($x, $y);
# Show user that Waypoints in MK are cleared
$WaypointsModified = 1;
&WpRedrawLines();
$map_status_line->configure ('-text' => "$Translate{'TargetCoordSent'} -> Lat: $PlayerPause_Lat Lon: $PlayerPause_Lon x: $x y: $y");
});
# Pick Waypoint
my $WpOldx;
my $WpOldy;
$map_canvas->bind('Waypoint' => '<Button-1>' => sub
{
# prepare to move
my ($x, $y) = ($Tk::event->x, $Tk::event->y);
$WpOldx = $x;
$WpOldy = $y;
});
# Move Waypoint
$map_canvas->bind('Waypoint' => '<Button1-Motion>' => sub
{
my ($x, $y) = ($Tk::event->x, $Tk::event->y);
my $id = $map_canvas->find('withtag', 'current');
# move icon and Wp-Number
my $WpIndex = &WpGetIndexFromId($id);
if ( $WpIndex >= 0 )
{
my $Tag = $Waypoints[$WpIndex]{'Tag'};
$map_canvas->move($Tag => $x - $WpOldx, $y - $WpOldy);
}
$WpOldx = $x;
$WpOldy = $y;
});
# Release Wp
$map_canvas->bind('Waypoint' => '<Button1-ButtonRelease>' => sub
{
my ($x, $y) = ($Tk::event->x, $Tk::event->y);
my $id = $map_canvas->find('withtag', 'current');
# take coords from lower/middle icon position
my ($x0, $y0, $x1, $y1) = $map_canvas->bbox ($id);
$x = $x0 + ($x1 - $x0)/2;
$y = $y1;
# update Waypoint-Array
my $WpIndex = &WpGetIndexFromId($id);
if ( $WpIndex >= 0 )
{
# got it: set new coords
my ($Lat, $Lon) = &MapXY2Gps($x, $y);
my $Wp = $Waypoints[$WpIndex];
$Wp->{'MapX'} = $x;
$Wp->{'MapY'} = $y;
$Wp->{'Pos_Lat'} = $Lat;
$Wp->{'Pos_Lon'} = $Lon;
# redraw connector-lines
&WpRedrawLines();
# red connectors: Wp still have to be sent to MK
$map_canvas->itemconfigure('Waypoint-Connector',
'-fill' => $Cfg->{'mkcockpit'}->{'ColorWpResend'},
);
$WaypointsModified = 1;
my $WpNum = $WpIndex + 1;
$map_status_line->configure ('-text' => "$Translate{'WpMoved'}: $WpNum -> Lat: $Lat Lon: $Lon x: $x y: $y");
}
});
# Mouse button 1 for POI
my $PoiOldx = 0;
my $PoiOldy = 0;
&PoiHide();
# Pick Poi
$map_canvas->bind('POI' => '<Button-1>' => sub
{
# prepare to move Icon
my ($x, $y) = ($Tk::event->x, $Tk::event->y);
$PoiOldx = $x;
$PoiOldy = $y;
});
# Move POI
$map_canvas->bind('POI' => '<Button1-Motion>' => sub
{
my ($x, $y) = ($Tk::event->x, $Tk::event->y);
my $id = $map_canvas->find('withtag', 'current');
$map_canvas->move($id => $x - $PoiOldx, $y - $PoiOldy);
$PoiOldx = $x;
$PoiOldy = $y;
});
# Release POI
$map_canvas->bind('POI' => '<Button1-ButtonRelease>' => sub
{
my ($x, $y) = ($Tk::event->x, $Tk::event->y);
my $id = $map_canvas->find('withtag', 'current');
my ($x0, $y0, $x1, $y1) = $map_canvas->bbox ($id);
$x = $x0 + ($x1 - $x0)/2;
$y = $y1;
($Poi_Lat, $Poi_Lon) = &MapXY2Gps($x, $y);
$map_status_line->configure ('-text' => "$Translate{'PoiMoved'}: -> Lat: $Poi_Lat Lon: $Poi_Lon x: $x y: $y");
});
# Reset Flight time
$map_canvas->bind('MK-OSD-Tim-Value' => '<Button-1>' => sub
{
$MkFlyingTime = 0;
});
# Reset ODO
$map_canvas->bind('MK-OSD-Odo-Value' => '<Button-1>' => sub
{
$OdoMeter = 0;
});
#
# Mouse button 3 context menu
#
my $map_menu = $map_canvas->Menu('-tearoff' => 0,
'-title' =>'None',
'-menuitems' =>
[
[Button => $Translate{'WpAddAndSend'}, -command => sub
{
# send Wp to MK
my ($Lat, $Lon) = &MapXY2Gps($MapCanvasX, $MapCanvasY);
&MkFlyTo ( -lat => $Lat,
-lon => $Lon,
-mode => "Waypoint",
-index => scalar @Waypoints,
);
# Add Wp to Waypoints list
&WpAdd (-lat => $Lat,
-lon => $Lon,
-x => $MapCanvasX,
-y => $MapCanvasY,
);
# switch player to Wp mode and redraw waypoints
&PlayerWpt();
$map_status_line->configure ('-text' => "$Translate{'WpSavedAndSent'} -> Lat: $Lat Lon: $Lon");
}],
[Button => $Translate{'WpProperties'}, -command => sub
{
# find Wp-Hash for selected icon/tag
my $WpIndex = &WpGetIndexFromId($MapCanvasId);
if ( $WpIndex >= 0 )
{
my $Wp = $Waypoints[$WpIndex];
my $WpNum = $WpIndex + 1;
&DisplayHash ($Wp, "$Translate{'WpProperties'} $WpNum", "Edit Waypoint Refresh");
$map_status_line->configure ('-text' => "$Translate{'WpProperties'} $WpNum");
}
}],
[Button => $Translate{'WpResendAll'}, -command => sub
{
&WpSendAll();
$map_status_line->configure ('-text' => $Translate{'WpAllSent'});
}],
'', # Separator
[Button => $Translate{'WpLoadAndSend'}, -command => sub
{
my $WpFile = $main->getOpenFile('-defaultextension' => ".xml",
'-filetypes' =>
[['Mission Cockpit', '.xml' ],
['Mikrokopter Tool', '.wpl' ],
['All Files', '*', ],
],
'-initialdir' => $Cfg->{'waypoint'}->{'WpDir'},
'-title' => $Translate{'WpLoad'},
);
if ( -f $WpFile )
{
&WpLoadFile ($WpFile);
# send all Wp to MK
&WpSendAll();
# switch player to Wp mode and redraw waypoints
$PlayerRandomMode = 'STD';
&PlayerWpt();
$map_status_line->configure ('-text' => "$Translate{'WpLoadedAndSent'}: $WpFile");
}
}],
[Button => $Translate{'WpSave'}, -command => sub
{
my $WpFile = $main->getSaveFile('-defaultextension' => ".xml",
'-filetypes' =>
[['Mission Cockpit', '.xml' ],
['Mikrokopter Tool', '.wpl' ],
['All Files', '*', ],
],
'-initialdir' => $Cfg->{'waypoint'}->{'WpDir'},
'-title' => $Translate{'WpSave'},
);
&WpSaveFile ($WpFile);
$map_status_line->configure ('-text' => "$Translate{'WpSaved'}: $WpFile");
}],
'', # Separator
[Button => $Translate{'WpDelete'}, -command => sub
{
# find Wp-Hash for selected icon/tag
my $WpIndex = &WpGetIndexFromId($MapCanvasId);
if ( $WpIndex >= 0 )
{
&WpDelete ($WpIndex);
# redraw connector-lines
$WaypointsModified = 1;
&WpRedrawLines();
&WpRedrawIcons(); # wg. Wp-Nummern
my $WpNum = $WpIndex + 1;
$map_status_line->configure ('-text' => "$Translate{'WpDeleted'}: $WpNum");
}
}],
[Button => $Translate{'WpAllDeleteAndSend'}, -command => sub
{
&WpDeleteAll();
&WpSendAll();
$map_status_line->configure ('-text' => "$Translate{'WpAllDeleted'}: $WpIndex");
}],
'', # Separator
[Button => $Translate{'KmlLoadAndPlay'}, -command => sub
{
$KmlFile = $main->getOpenFile('-defaultextension' => ".kml",
'-filetypes' =>
[['KML', '.kml' ],
['All Files', '*', ],
],
'-initialdir' => $Cfg->{'waypoint'}->{'KmlDir'},
'-title' => $Translate{'KmlLoad'},
);
if ( -f $KmlFile )
{
&KmlLoadFile($KmlFile);
# switch player to KML mode and redraw track
&PlayerKml();
$map_status_line->configure ('-text' => "$Translate{'KmlLoaded'}: $KmlFile" );
}
}],
]
);
$map_canvas->CanvasBind("<Button-3>" => [ sub
{
$map_canvas->focus;
my($w, $x, $y) = @_;
($MapCanvasX, $MapCanvasY) = ($Tk::event->x, $Tk::event->y);
$MapCanvasId = $map_canvas->find('withtag', 'current');
$map_menu->post($x, $y);
}, Ev('X'), Ev('Y') ] );
# Mouse bindings
$map_canvas->bind('Wp-PlayPause' => '<Button-1>' => \&CbPlayerPlayPause );
$map_canvas->bind('Wp-Next' => '<Button-1>' => \&CbPlayerNext );
$map_canvas->bind('Wp-Prev' => '<Button-1>' => \&CbPlayerPrev );
$map_canvas->bind('Wp-First' => '<Button-1>' => \&CbPlayerFirst );
$map_canvas->bind('Wp-Last' => '<Button-1>' => \&CbPlayerLast );
$map_canvas->bind('Wp-Home' => '<Button-1>' => \&CbPlayerHome );
$map_canvas->bind('Wp-Stop' => '<Button-1>' => \&CbPlayerStop );
$map_canvas->bind('Wp-WptKml' => '<Button-1>' => \&CbPlayerWptKml );
$map_canvas->bind('Wp-WptRandom' => '<Button-1>' => \&CbPlayerWptRandom );
$map_canvas->bind('Wp-Record' => '<Button-1>' => \&CbPlayerRecord );
# Focus Canvas, if any key pressed. Needed for the following key-bindings
my $bBindFocus = 0;
$main->bind('<Any-Enter>' => sub
{
if ($bBindFocus == 0)
{
# focus only once. Verhindern vom canvas-popup, wenn Config-Dialog aktiv ist.
# funktioniert so, habe aber keine Ahnung warum
$map_canvas->Tk::focus;
$bBindFocus = 1;
}
});
# Disable default arrow-key bindings on canvas
$main->bind('Tk::Canvas',"<$_>",undef)for qw /Left Right Up Down/;
# keyboard bindings
$map_canvas->Tk::bind( '<Key-space>' , \&CbPlayerPlayPause );
$map_canvas->Tk::bind( '<Key-n>' , \&CbPlayerNext );
$map_canvas->Tk::bind( '<Key-p>' , \&CbPlayerPrev );
$map_canvas->Tk::bind( '<Key-f>' , \&CbPlayerFirst );
$map_canvas->Tk::bind( '<Key-l>' , \&CbPlayerLast );
$map_canvas->Tk::bind( '<Key-h>' , \&CbPlayerHome );
$map_canvas->Tk::bind( '<Key-s>' , \&CbPlayerStop );
$map_canvas->Tk::bind( '<Key-w>' , \&CbPlayerWptKml );
$map_canvas->Tk::bind( '<Key-k>' , \&CbPlayerWptKml );
$map_canvas->Tk::bind( '<Key-r>' , \&CbPlayerWptRandom );
$map_canvas->Tk::bind( '<Key-a>' , \&CbPlayerRecord );
$map_canvas->Tk::bind( '<Key-m>' , \&CbPlayerMute );
$map_canvas->Tk::bind( '<Key-v>' , \&CbPoi );
$map_canvas->Tk::bind( '<Key-g>' , \&CbGrid );
$map_canvas->Tk::bind( '<Key-x>' , \&CbPlayerPauseMode );
$map_canvas->Tk::bind( '<Key-0>' , [\&CbPlayerNum, "0"] );
$map_canvas->Tk::bind( '<Key-1>' , [\&CbPlayerNum, "1"] );
$map_canvas->Tk::bind( '<Key-2>' , [\&CbPlayerNum, "2"] );
$map_canvas->Tk::bind( '<Key-3>' , [\&CbPlayerNum, "3"] );
$map_canvas->Tk::bind( '<Key-4>' , [\&CbPlayerNum, "4"] );
$map_canvas->Tk::bind( '<Key-5>' , [\&CbPlayerNum, "5"] );
$map_canvas->Tk::bind( '<Key-6>' , [\&CbPlayerNum, "6"] );
$map_canvas->Tk::bind( '<Key-7>' , [\&CbPlayerNum, "7"] );
$map_canvas->Tk::bind( '<Key-8>' , [\&CbPlayerNum, "8"] );
$map_canvas->Tk::bind( '<Key-9>' , [\&CbPlayerNum, "9"] );
$map_canvas->Tk::bind( '<Key-Left>' , [\&CbPlayerMove, -1, 0] );
$map_canvas->Tk::bind( '<Key-Right>' , [\&CbPlayerMove, 1, 0] );
$map_canvas->Tk::bind( '<Key-Up>' , [\&CbPlayerMove, 0, 1] );
$map_canvas->Tk::bind( '<Key-Down>' , [\&CbPlayerMove, 0, -1] );
$map_canvas->Tk::bind( '<Key-Escape>', \&CbExit );
$map_canvas->Tk::bind( '<Key-Return>', \&CbTxOnOff );
#
# dynamic objecs on canvas
#
# current MK position on canvas
$MkPos_x = $MapSizeX/2;
$MkPos_y = $MapSizeY/2;
# Line from MK to Home
$map_canvas->createLine ( $MapSizeX/2, $MapSizeY/2, $MapSizeX/2, $MapSizeY/2,
'-tags' => 'MK-Home-Line',
'-arrow' => 'none',
'-fill' => $Cfg->{'mkcockpit'}->{'ColorHomeLine'},
'-width' => 3,
);
# Text Entfernung positioniert an der Home-Linie
$map_canvas->createText ( $MapSizeX/2 + 8, $MapSizeY/2 - 8,
'-tags' => 'MK-Home-Dist',
'-text' => '0 m',
'-anchor' => 'w',
'-font' => '-*-Arial-Bold-R-Normal--*-200-*',
'-fill' => $Cfg->{'mkcockpit'}->{'ColorHomeDist'},
);
# Line from MK to Target, draw invisible out of sight
$map_canvas->createLine ( 0, -100, 0, -100,
'-tags' => 'MK-Target-Line',
'-arrow' => 'none',
'-fill' => $Cfg->{'mkcockpit'}->{'ColorTargetLine'},
'-width' => 3,
);
# Text Entfernung positioniert an der Target-Linie
$map_canvas->createText ( 0, -100,
'-tags' => 'MK-Target-Dist',
'-text' => '0 m',
'-anchor' => 'w',
'-font' => '-*-Arial-Bold-R-Normal--*-200-*',
'-fill' => $Cfg->{'mkcockpit'}->{'ColorTargetDist'},
);
# Line from MK to POI, draw invisible out of sight
$map_canvas->createLine ( 0, -200, 0, -200,
'-tags' => 'MK-POI-Line',
'-arrow' => 'none',
'-fill' => $Cfg->{'mkcockpit'}->{'ColorPoiLine'},
'-stipple' => "stipple4",
'-width' => 1,
);
$map_canvas->lower('MK-POI-Line', 'Target');
# MK Geschwindigkeits-Vektor
$MapMkSpeedLen = 60; # Länge Speed-Zeiger
my $x0 = $MapSizeX/2;
my $y0 = $MapSizeY/2;
my $x1 = $MapSizeX/2;
my $y1 = $MapSizeY/2 - $MapMkSpeedLen;
$map_canvas->createLine ( $x0, $y0, $x1, $y1,
'-tags' => 'MK-Speed',
'-arrow' => 'last',
'-arrowshape' => [10, 10, 3 ],
'-fill' => $Cfg->{'mkcockpit'}->{'ColorSpeedVector'},
'-width' => 4,
);
# MK als Pfeilspitze einer Linie darstellen
$MapMkLen = 25;
my $x0 = $MapSizeX/2;
my $y0 = $MapSizeY/2 + $MapMkLen/2;
my $x1 = $MapSizeX/2;
my $y1 = $MapSizeY/2 - $MapMkLen/2;
$map_canvas->createLine ( $x0, $y0, $x1, $y1,
'-tags' => 'MK-Arrow',
'-arrow' => 'last',
'-arrowshape' => [25, 30, 10 ],
'-fill' => $Cfg->{'mkcockpit'}->{'ColorMkSatNo'},
'-width' => 1
);
# OSD Texte auf Karte anzeigen
my @Texts = (
# Tag Text Pos_x Pos_y Font
'MK-OSD-Tim-Label', "TIM", $MapSizeX/2 + 30, 20, '-*-Arial-Bold-R-Normal--*-150-*',
'MK-OSD-Tim-Value', "00:00", $MapSizeX/2 + 80, 20, '-*-Arial-Bold-R-Normal--*-270-*',
'MK-OSD-Bat-Label', "BAT", $MapSizeX/2 + 30, 50, '-*-Arial-Bold-R-Normal--*-150-*',
'MK-OSD-Bat-Value', "0.0 V", $MapSizeX/2 + 80, 50, '-*-Arial-Bold-R-Normal--*-270-*',
'MK-OSD-Cap-Label', "CAP", $MapSizeX/2 - 150, 20, '-*-Arial-Bold-R-Normal--*-150-*',
'MK-OSD-Cap-Value', "0.00 Ah", $MapSizeX/2 - 100, 20, '-*-Arial-Bold-R-Normal--*-270-*',
'MK-OSD-Cur-Label', "CUR", $MapSizeX/2 - 150, 50, '-*-Arial-Bold-R-Normal--*-150-*',
'MK-OSD-Cur-Value', "0.0 A", $MapSizeX/2 - 100, 50, '-*-Arial-Bold-R-Normal--*-270-*',
'MK-OSD-Pow-Label', "POW", $MapSizeX/2 - 150, 80, '-*-Arial-Bold-R-Normal--*-150-*',
'MK-OSD-Pow-Value', "0.0 W", $MapSizeX/2 - 100, 80, '-*-Arial-Bold-R-Normal--*-270-*',
'MK-OSD-Spd-Label', "SPD", 10, 20, '-*-Arial-Bold-R-Normal--*-150-*',
'MK-OSD-Spd-Value', "0.0 km/h", 60, 20, '-*-Arial-Bold-R-Normal--*-270-*',
'MK-OSD-Alt-Label', "ALT", 10, 50, '-*-Arial-Bold-R-Normal--*-150-*',
'MK-OSD-Alt-Value', "0 m", 60, 50, '-*-Arial-Bold-R-Normal--*-270-*',
'MK-OSD-Odo-Label', "ODO", 10, 80, '-*-Arial-Bold-R-Normal--*-150-*',
'MK-OSD-Odo-Value', "0.000 km", 60, 80, '-*-Arial-Bold-R-Normal--*-270-*',
'MK-OSD-Sat-Label', "SAT", $MapSizeX - 230, 20, '-*-Arial-Bold-R-Normal--*-150-*',
'MK-OSD-Sat-Value', "0", $MapSizeX - 180, 20, '-*-Arial-Bold-R-Normal--*-270-*',
'MK-OSD-Wp-Label', "WPT", $MapSizeX - 230, 50, '-*-Arial-Bold-R-Normal--*-150-*',
'MK-OSD-Wp-Value', "0 / 0", $MapSizeX - 180, 50, '-*-Arial-Bold-R-Normal--*-270-*',
'MK-OSD-Mode-Label', "MOD", $MapSizeX - 230, 80, '-*-Arial-Bold-R-Normal--*-150-*',
'MK-OSD-Mode-Value', "", $MapSizeX - 180, 80, '-*-Arial-Bold-R-Normal--*-270-*',
'MK-OSD-Rec-Value', "", $MapSizeX - 180, 110, '-*-Arial-Bold-R-Normal--*-200-*',
);
my $i = 0;
for $Text (0 .. $#Texts/5)
{
my $Tag = $Texts[$i++];
my $Text = $Texts[$i++];
my $Pos_x = $Texts[$i++];
my $Pos_y = $Texts[$i++];
my $Font = $Texts[$i++];
$map_canvas->createText ( $Pos_x, $Pos_y,
'-tags' => $Tag,
'-text' => $Text,
'-font' => $Font,
'-fill' => $Cfg->{'mkcockpit'}->{'ColorOsd'},
'-anchor' => 'w',
);
}
# Variometer on canvas
my @Polygon;
for ( $y = -100; $y <= 100; $y += 10)
{
my $Len = 5;
if ( ($y % 50) == 0 )
{
$Len = 10;
$map_canvas->createText ( $Len+5, $MapSizeY/2 + $y,
'-tags' => 'Map-Variometer-Skala',
'-text' => sprintf ("%3d", -$y / 10),
'-anchor' => 'w',
'-font' => '-*-Arial-Normal-R-Normal--*-150-*',
'-fill' => $Cfg->{'mkcockpit'}->{'ColorVariometer'},
);
}
push @Polygon, ( 0, $MapSizeY/2 + $y);
push @Polygon, ($Len, $MapSizeY/2 + $y);
push @Polygon, ( 0, $MapSizeY/2 + $y);
}
$map_canvas->createLine(@Polygon,
'-tags' => 'Map-Variometer',
'-fill' => $Cfg->{'mkcockpit'}->{'ColorVariometer'},
'-width' => 2,
'-arrow' => 'none',
);
# Vario Pointer
$map_canvas->createPolygon( 5, $MapSizeY/2, 20, $MapSizeY/2+10, 20, $MapSizeY/2-10,
'-tags' => 'Map-Variometer-Pointer',
'-fill' => $Cfg->{'mkcockpit'}->{'ColorVariometerPointer'},
'-outline' => 'black', '-width' => 1,
);
# Crosshair
$map_canvas->createLine ( 0, $MapSizeY/2, $MapSizeX, $MapSizeY/2,
'-tags' => ['Map-Crosshair', 'Map-Crosshair-X'],
'-arrow' => 'none',
'-fill' => $Cfg->{'map'}->{'CrosshairColor'},
'-width' => 1,
);
$map_canvas->createLine ( $MapSizeX/2, 0, $MapSizeX/2, $MapSizeY,
'-tags' => ['Map-Crosshair', 'Map-Crosshair-Y'],
'-arrow' => 'none',
'-fill' => $Cfg->{'map'}->{'CrosshairColor'},
'-width' => 1,
);
$map_canvas->lower('Map-Crosshair', 'Map'); # hide below map
# Tracking Canvas
if ( $Cfg->{'track'}->{'Active'} =~ /y/i )
{
# Canvas size
$TrackSizeX = 125;
$TrackSizeY = 100;
$TrackOffY = $TrackSizeY - $MapSizeY + $TrackSizeY/2;
$TrackPtrLen = 50; # Länge Zeiger
# draw in map-canvas
$track_canvas = $map_canvas;
# Ziffernblatt
my $x0 = $TrackSizeX/2 - $TrackPtrLen;
my $y0 = $TrackSizeY + $TrackPtrLen - $TrackOffY;
my $x1 = $TrackSizeX/2 + $TrackPtrLen;
my $y1 = $TrackSizeY - $TrackPtrLen - $TrackOffY;
$track_canvas->createArc ( $x0, $y0, $x1, $y1,
'-extent' => '359',
'-start' => '0',
'-style' => 'chord',
'-outline' => 'gray', '-width' => '1',
);
# Skala Ziffernblatt
for ($i=0; $i<360; $i+=15)
{
my $x0 = $TrackSizeX/2 - ($TrackPtrLen - 20) * cos( deg2rad $i );
my $y0 = $TrackSizeY - ($TrackPtrLen - 20) * sin( deg2rad $i ) - $TrackOffY;
my $x1 = $TrackSizeX/2 - ($TrackPtrLen - 28) * cos( deg2rad $i );
my $y1 = $TrackSizeY - ($TrackPtrLen - 28) * sin( deg2rad $i ) - $TrackOffY;
$track_canvas->createLine ( $x0, $y0, $x1, $y1,
'-fill' => 'white',
'-width' => 1,
);
}
# Skala Beschriftung Ziffernblatt
for ($i=-180; $i<180; $i+=45)
{
my $x0 = $TrackSizeX/2 - ($TrackPtrLen - 12) * cos( deg2rad $i+90 );
my $y0 = $TrackSizeY - ($TrackPtrLen - 12) * sin( deg2rad $i+90 ) - $TrackOffY;
$track_canvas->createText ( $x0, $y0,
'-text' => $i,
'-fill' => 'white',
);
}
# Zeiger Pan
my $x0 = $TrackSizeX/2;
my $y0 = $TrackSizeY - 0 - $TrackOffY;
my $x1 = $TrackSizeX/2;
my $y1 = $TrackSizeY - ($TrackPtrLen - 22) - $TrackOffY;
$track_canvas->createLine ( $x0, $y0, $x1, $y1,
'-tags' => 'Track-Ptr-Pan',
'-arrow' => 'last',
'-arrowshape' => [20, 30, 5 ],
'-fill' => 'red',
'-width' => 8,
);
# Zeiger Tilt
my $x0 = $TrackSizeX/2;
my $y0 = $TrackSizeY - 0 - $TrackOffY;
my $x1 = $TrackSizeX/2;
my $y1 = $TrackSizeY - ($TrackPtrLen - 22) - $TrackOffY;
$track_canvas->createLine ( $x0, $y0, $x1, $y1,
'-tags' => 'Track-Ptr-Tilt',
'-fill' => 'white',
'-width' => 1,
);
# Zeiger Center
my $Dia = 7;
my $x0 = $TrackSizeX/2 - $Dia;
my $y0 = $TrackSizeY + $Dia - $TrackOffY;
my $x1 = $TrackSizeX/2 + $Dia;
my $y1 = $TrackSizeY - $Dia - $TrackOffY;
$track_canvas->createArc ( $x0, $y0, $x1, $y1,
'-extent' => '359',
'-outline' => 'gray', '-width' => 1,
'-fill' => 'gray',
);
}
#
# Load Start Scenario
#
# Waypoint file
my $CfgVal = $Cfg->{'StartScenario'}->{'WpFile'};
if ( ! -f $CfgVal )
{
$CfgVal = $Cfg->{'waypoint'}->{'WpDir'} . "/" . $Cfg->{'StartScenario'}->{'WpFile'};
}
if ( -f $CfgVal )
{
&WpLoadFile($CfgVal);
# send all Wp to MK
&WpSendAll();
}
# KML file
my $CfgVal = $Cfg->{'StartScenario'}->{'KmlFile'};
if ( ! -f $CfgVal )
{
$CfgVal = $Cfg->{'waypoint'}->{'KmlDir'} . "/" . $Cfg->{'StartScenario'}->{'KmlFile'};
}
if ( -f $CfgVal )
{
&KmlLoadFile($CfgVal);
}
# PLayer Mode
my $CfgVal = $Cfg->{'StartScenario'}->{'PlayerMode'};
if ( $CfgVal =~ /Play/i ) { &PlayerPlay(); }
if ( $CfgVal =~ /Pause/i ) { &PlayerPause(); }
if ( $CfgVal =~ /Home/i ) { &PlayerHome(); }
if ( $CfgVal =~ /Stop/i ) { &PlayerStop(); }
# Player Random Mode
my $CfgVal = $Cfg->{'StartScenario'}->{'PlayerRandomMode'};
if ( $CfgVal eq "STD" ) { &PlayerRandomStd(); }
if ( $CfgVal eq "RND" ) { &PlayerRandomRnd(); }
if ( $CfgVal eq "MAP" ) { &PlayerRandomMap(); }
# PLayer Wpt/Kml Mode
my $CfgVal = $Cfg->{'StartScenario'}->{'PlayerWptKmlMode'};
if ( $CfgVal eq "WPT" ) { &PlayerWpt(); }
if ( $CfgVal eq "KML" ) { &PlayerKml(); }
# PLayer Pause Mode
my $CfgVal = $Cfg->{'StartScenario'}->{'PlayerPauseMode'};
if ( $CfgVal eq "MAP" ) { &PlayerPauseMode("MAP"); }
if ( $CfgVal eq "MK" ) { &PlayerPauseMode("MK"); }
# Audio TTS Mute
my $CfgVal = $Cfg->{'StartScenario'}->{'AudioMute'};
if ( $CfgVal =~ /y/i )
{
$TtsMute = 1;
}
# External-Contorl/Serial Channel Tx On/Off
my $CfgVal = $Cfg->{'StartScenario'}->{'TxExtOn'};
if ( $CfgVal =~ /y/i )
{
$TxExtOn = 1;
}
#
# Timer
#
require "libmktimer.pl";
MainLoop(); # should never end
#
# GUI Call Back
#
# Player CallBack: Play/Pause button
sub CbPlayerPlayPause()
{
if ( ($PlayerMode eq "Pause") or ($PlayerMode eq "Stop") or ($PlayerMode eq "Home") )
{
&PlayerPlay();
}
else
{
&PlayerPause();
}
}
# Player CallBack: Next
sub CbPlayerNext()
{
if ( $PlayerMode ne 'Stop' )
{
if ( $PlayerWptKmlMode eq 'WPT' )
{
&WpTargetNext();
}
if ( $PlayerWptKmlMode eq 'KML' )
{
&KmlTargetNext();
}
}
}
# Player CallBack: Prev
sub CbPlayerPrev()
{
if ( $PlayerMode ne 'Stop' )
{
if ( $PlayerWptKmlMode eq 'WPT' )
{
&WpTargetPrev();
}
if ( $PlayerWptKmlMode eq 'KML' )
{
&KmlTargetPrev();
}
}
}
# Player CallBack: First
sub CbPlayerFirst()
{
if ( $PlayerMode ne 'Stop' )
{
if ( $PlayerWptKmlMode eq 'WPT' )
{
&WpTargetFirst();
}
if ( $PlayerWptKmlMode eq 'KML' )
{
&KmlTargetFirst();
}
}
}
# Player CallBack: Last
sub CbPlayerLast()
{
if ( $PlayerMode ne 'Stop' )
{
if ( $PlayerWptKmlMode eq 'WPT' )
{
&WpTargetLast();
}
if ( $PlayerWptKmlMode eq 'KML' )
{
&KmlTargetLast();
}
}
}
# Player CallBack: Home
sub CbPlayerHome()
{
if ( $PlayerMode ne 'Stop' )
{
&PlayerHome();
}
}
# Player CallBack: Stop
sub CbPlayerStop()
{
if ( $PlayerMode ne 'Stop' )
{
&PlayerStop();
}
}
# Player CallBack: Move MK in Pause-Mode
sub CbPlayerMove()
{
my ($Id, $DirX, $DirY) = @_;
if ( $PlayerMode eq 'Pause' and
$PlayerPause_Lat ne "" and $PlayerPause_Lon ne "" )
{
my $Dist = $Cfg->{'map'}->{'PauseMoveDist'} || 1; # 1m default
my $BearingTop = &MapAngel() - 90.0;
my $BearingKey = rad2deg atan2($DirX, $DirY);
my $Bearing = $BearingTop + $BearingKey;
if ( $PlayerPauseMode eq "MK" )
{
# MK Reference
$Bearing = $MkOsd{'CompassHeading'} + $BearingKey;
}
($PlayerPause_Lat, $PlayerPause_Lon) = &MapGpsAt($PlayerPause_Lat, $PlayerPause_Lon, $Dist, $Bearing);
# restart crosshair display timer
$CrosshairTimerCnt = 0;
}
}
# Player CallBack: Toggle WPT/KML button
sub CbPlayerWptKml()
{
if ( $PlayerWptKmlMode =~ /WPT/i )
{
&PlayerKml();
}
elsif ( $PlayerWptKmlMode =~ /KML/i )
{
&PlayerWpt();
}
}
# Player CallBack: Toggle Random modes. STD -> RND -> MAP
sub CbPlayerWptRandom()
{
if ( $PlayerRandomMode eq "STD" )
{
&PlayerRandomRnd();
}
elsif ( $PlayerRandomMode eq "RND" )
{
&PlayerRandomMap();
}
else
{
&PlayerRandomStd();
}
}
# Player CallBack: Togglle Record KML
sub CbPlayerRecord()
{
if ( $PlayerRecordMode =~ /REC/i )
{
&PlayerRecordOff();
}
elsif ( $PlayerRecordMode eq "" )
{
&PlayerRecordOn();
}
}
# Player CallBack: Number Keys
sub CbPlayerNum()
{
my ($Id, $Num) = @_;
$CbPlayerKey = "$CbPlayerKey" . "$Num";
}
# Player CallBack: mute TTS audio
sub CbPlayerMute()
{
if ( $TtsMute )
{
&TtsMute(0);
}
else
{
&TtsMute(1);
}
}
# Switch POI Mode
sub CbPoi()
{
if ( $PoiMode )
{
$PoiMode = 0;
&PoiHide();
}
else
{
$PoiMode = 1;
&PoiShow();
}
}
# Grid on canvas
$GridIsOn = 0;
sub CbGrid()
{
if ( $GridIsOn )
{
$GridIsOn = 0;
&GridHide();
}
else
{
$GridIsOn = 1;
&GridShow();
}
}
# Player Pause Mode
sub CbPlayerPauseMode()
{
if ( $PlayerPauseMode eq "MAP" )
{
&PlayerPauseMode("MK");
}
else
{
&PlayerPauseMode("MAP");
}
}
# External-Control, SerialChannel On/Off
sub CbTxOnOff()
{
if ( $TxExtOn == 1 )
{
$TxExtOn = 0;
}
else
{
$TxExtOn = 1;
}
}
# CallBack: Exit Mission Cockpit
sub CbExit()
{
# stop 3D Mouse
&Mouse3DStop();
# stop Joystick
&JoystickStop();
# stop antenna tracking
$TrackQueue->enqueue( "IDLE" );
# wait for tracker shutdown, with timeout
if ( $MkTrack{'Active'} =~ /y/i )
{
for ($i=0; $i < 5; $i++)
{
if ( $MkTrack{'State'} ne "Idle" )
{
sleep 1;
}
}
}
exit;
}
__END__

/MissionCockpit/tags/V0.4.0/mkcockpit.xml
0,0 → 1,136
<mkcockpit-Config CreationDate="20100210-201134"
Version="0.4.0 - 2010-02-09">
<StartScenario AudioMute="No"
EventFile="mkevent.xml"
KmlFile=""
PlayerMode="Stop"
PlayerPauseMode="MAP"
PlayerRandomMode="STD"
PlayerWptKmlMode="WPT"
TxExtOn="No"
WpFile="" />
<externcontrol ExternControlFrequency="20"
ExternControlGas="255"
ExternControlGasExpo=""
ExternControlGasLimit=""
ExternControlGier="0"
ExternControlGierExpo=""
ExternControlGierLimit=""
ExternControlHeight=""
ExternControlNick="0"
ExternControlNickExpo=""
ExternControlNickLimit=""
ExternControlRoll="0"
ExternControlRollExpo=""
ExternControlRollLimit=""
ExternControlSend="No" />
<logging CsvLogDir="log"
GpxLogDir="log"
HttpPort="8080"
Intervall="0.5"
KmlLogDir="log" />
<map CrosshairColor="white"
CrosshairMoveX="JoystickX"
CrosshairMoveXExpo="20"
CrosshairMoveXLimit="100"
CrosshairMoveY="JoystickY"
CrosshairMoveYExpo="20"
CrosshairMoveYLimit="100"
GridColor="#909090"
GridDist="50"
MapDefault="Hemhofen"
MapDir="map"
PauseMoveDist="1.0"
SimImageSize="300"
UsedCapacityFactor="1.07" />
<mkcockpit AltFactor="22.5"
ColorAirfield="blue"
ColorFootprint="magenta"
ColorHomeDist="white"
ColorHomeLine="red"
ColorKmlTrack="gray"
ColorMkSatGood="yellow"
ColorMkSatLow="orange"
ColorMkSatNo="red"
ColorOsd="white"
ColorPoiLine="white"
ColorScale="white"
ColorSpeedVector="white"
ColorTargetDist="cyan"
ColorTargetLine="green"
ColorVariometer="white"
ColorVariometerPointer="yellow"
ColorWpConnector="gray"
ColorWpNumber="gray"
ColorWpResend="red"
FootprintLength="120"
IconFox="icon/bear_48.gif"
IconHeartLarge="icon/heart_48.gif"
IconHeartSmall="icon/heart_32.gif"
IconPoi="icon/webcam_48.gif"
IconSatellite="icon/satellite_64.gif"
IconTarget="icon/target_48.gif"
IconWaypoint="icon/waypoint_24x48.gif"
UBatWarning="10.0" />
<mkcomm Port="COM1"
PortSetSkip="No" />
<serialchannel SerialChannel01=""
SerialChannel02=""
SerialChannel03=""
SerialChannel04=""
SerialChannel05=""
SerialChannel06=""
SerialChannel07=""
SerialChannel08=""
SerialChannel09=""
SerialChannel10=""
SerialChannel11=""
SerialChannel12=""
SerialChannelFrequency="20"
SerialChannelSend="No" />
<track Active="No"
IconAntenna="icon/Antenna_48.gif"
Port="COM8"
PortSetSkip="No"
ServoPanCtrl="15"
ServoPanNeutral="3000"
ServoPanSpeed="0"
ServoTiltCtrl="46"
ServoTiltNeutral="3000"
ServoTiltSpeed="0" />
<tts Active="Yes"
Message1="FLIGHT_TIME"
Message2="BATTERY"
Message3="ALTITUDE"
Message4="SATELLITES"
Message5=""
Message6=""
Message7=""
Message8=""
Message9=""
Options="-v de -a 200 -s 200"
Program="C:/Program Files/eSpeak/command_line/espeak.exe"
StatusInterval="20"
Welcome="Starte Mischn Kockpit, Bitte anschnallen, und das Rauchen einstellen." />
<waypoint DefaultEventFlag="0"
DefaultHeading="0"
DefaultHoldtime="2"
DefaultToleranceRadius="5"
IconFirst="icon/WpFirst.gif"
IconHome="icon/WpHome.gif"
IconKml="icon/ModeKml_48.gif"
IconLast="icon/WpLast.gif"
IconNext="icon/WpNext.gif"
IconPause="icon/WpPause.gif"
IconPlay="icon/WpPlay.gif"
IconPrev="icon/WpPrev.gif"
IconRandomMap="icon/RandomMap_48.gif"
IconRandomOff="icon/RandomOff_48.gif"
IconRandomOn="icon/RandomWpt_48.gif"
IconRecord="icon/Record_48.gif"
IconStop="icon/WpStop.gif"
IconWpt="icon/ModeWpt_48.gif"
KmlDir="log"
KmlTimeBase="0.5"
WpDir="waypoints" />
</mkcockpit-Config>

/MissionCockpit/tags/V0.4.0/mkcomm.pl
0,0 → 1,852
#!/usr/bin/perl
#!/usr/bin/perl -d:ptkdb
###############################################################################
#
# mkcomm.pl - MK Communication Routines
#
# Copyright (C) 2009 Rainer Walther (rainerwalther-mail@web.de)
#
# Creative Commons Lizenz mit den Zusaetzen (by, nc, sa)
#
# Es ist Ihnen gestattet:
# * das Werk vervielfältigen, verbreiten und öffentlich zugänglich machen
# * Abwandlungen bzw. Bearbeitungen des Inhaltes anfertigen
#
# Zu den folgenden Bedingungen:
# * Namensnennung.
# Sie müssen den Namen des Autors/Rechteinhabers in der von ihm festgelegten Weise nennen.
# * Keine kommerzielle Nutzung.
# Dieses Werk darf nicht für kommerzielle Zwecke verwendet werden.
# * Weitergabe unter gleichen Bedingungen.
# Wenn Sie den lizenzierten Inhalt bearbeiten oder in anderer Weise umgestalten,
# verändern oder als Grundlage für einen anderen Inhalt verwenden,
# dürfen Sie den neu entstandenen Inhalt nur unter Verwendung von Lizenzbedingungen
# weitergeben, die mit denen dieses Lizenzvertrages identisch oder vergleichbar sind.
#
# Im Falle einer Verbreitung müssen Sie anderen die Lizenzbedingungen, unter welche dieses
# Werk fällt, mitteilen. Am Einfachsten ist es, einen Link auf diese Seite einzubinden.
#
# Jede der vorgenannten Bedingungen kann aufgehoben werden, sofern Sie die Einwilligung
# des Rechteinhabers dazu erhalten.
#
# Diese Lizenz lässt die Urheberpersönlichkeitsrechte unberührt.
#
# Weitere Details zur Lizenzbestimmung gibt es hier:
# Kurzform: http://creativecommons.org/licenses/by-nc-sa/3.0/de/
# Komplett: http://creativecommons.org/licenses/by-nc-sa/3.0/de/legalcode
#
###############################################################################
# 2009-02-21 0.0.1 rw created
# 2009-03-18 0.0.2 rw NC 0.14e
# 2009-04-01 0.1.0 rw RC1
# 2009-04-06 0.1.1 rw NC 0.15c
# 2009-05-16 0.1.2 rw External control
# 2009-08-15 0.1.3 rw SIG-Handler removed
# 2009-10-05 0.1.4 rw COM-Ports > 9 + PortSetSkip configuration
# Export Target-Hash to Simulator
# 2009-10-24 0.3.0 rw NC 0.17b
# 2010-02-10 0.4.0 rw Port read timout reduced from 100ms to 10ms
# Serial Channel
# Extern Control
# Controls via joystick or 3D-Mouse
# Navidata Current, Capacity
#
###############################################################################
$Version{'mkcomm.pl'} = "0.4.0 - 2010-02-10";
# MK Protokoll
# http://www.mikrokopter.de/ucwiki/en/SerialCommands?highlight=(command)
# http://www.mikrokopter.de/ucwiki/en/SerialProtocol?highlight=(protocol)
#
# Parameter
#
# Com Port of MK Comm-Device (BT, WI.232)
if ( ! defined $Cfg->{'mkcomm'}->{'Port'} )
{
# set default
$Cfg->{'mkcomm'}->{'Port'} = "COM5";
}
$AddrFC = "b";
$AddrNC = "c";
$AddrMK3MAG = "d";
if ( $0 =~ /mkcomm.pl$/i )
{
# Program wurde direkt aufgerufen
# change working directory to program path
my $Cwd = substr ($0, 0, rindex ($0, "mkcomm.pl"));
chdir $Cwd;
# set path for local Perl libs
push @INC, $Cwd . "perl/lib";
}
# Packages
use threads; # http://search.cpan.org/~jdhedden/threads-1.72/threads.pm
# http://perldoc.perl.org/threads.html
use threads::shared; # http://search.cpan.org/~jdhedden/threads-shared-1.28/shared.pm
use Thread::Queue; # http://search.cpan.org/dist/Thread-Queue-2.11/lib/Thread/Queue.pm
use Time::HiRes qw(usleep); # http://search.cpan.org/~jhi/Time-HiRes-1.9719/HiRes.pm
if ( $^O =~ /Win32/i )
{
require Win32::SerialPort; # http://search.cpan.org/dist/Win32-SerialPort
}
else
{
require Device::SerialPort; # http://search.cpan.org/~cook/Device-SerialPort-1.04/SerialPort.pm
}
require "libmap.pl";
# Hashes exported to other threads and main-program
share (%MkOsd);
share (%MkTarget);
share (%MkNcDebug);
share (%Mk);
share (%MkSSim); # Target info for simulator
share (%MkSerialChannel);
# Queue for Sending to MK
$MkSendQueue = Thread::Queue->new();
sub MkCommExit()
{
# close COM port
&MkClose();
if ( defined threads->self() )
{
threads->exit();
}
exit;
}
sub MkInit()
{
if ( defined $MkPort )
{
return; # already open
}
# open COM-Port
my $MkComPort = $Cfg->{'mkcomm'}->{'Port'};
if ( $MkComPort =~ /^COM/i )
{
$MkComPort = "\\\\.\\" . $MkComPort; # \\.\COMnn for nn > 9
}
undef $MkPort;
if ( $^O =~ m/Win32/ )
{
$MkPort = Win32::SerialPort->new ($MkComPort) || die "Error open $MkComPort\n";
}
else
{
$MkPort = Device::SerialPort->new ($MkComPort) || die "Error open $MkComPort\n";
}
if ( ! ($Cfg->{'mkcomm'}->{'PortSetSkip'} =~ /y/i) )
{
# Set COM parameters, don't set for Bluetooth device
$MkPort->baudrate(57600);
$MkPort->parity("none");
$MkPort->databits(8);
$MkPort->stopbits(1);
$MkPort->handshake('none');
$MkPort->write_settings;
}
$MkPort->read_const_time(10); # total = (avg * bytes) + const (ms)
}
# Read one line from MK
# Check send-queue
sub MkIOLine()
{
# Init serial port
&MkInit();
my $RxLine = "";
while ( 1 )
{
# Check Send-Queue
my $Items = $MkSendQueue->pending();
if ( $Items >= 3 ) # Cmd, Addr, Data
{
my ($Id, $Addr, $Data) = $MkSendQueue->dequeue(3);
&MkSend ($Id, $Addr, $Data);
}
# Zeichenweise lesen, blockierend mit Timeout
my ($RxLen, $RxChar) = $MkPort->read(1);
if ( $RxLen == 1 )
{
if ( "$RxChar" eq "#" ) # 1st char of line
{
$RxLine = "#";
}
elsif ( "$RxChar" eq "\r" ) # last char of line
{
return ($RxLine);
}
else
{
$RxLine = "$RxLine" . "$RxChar"; # collect char
}
}
}
}
# Read and decode a command from MK
# process send queue in &MkIOLine()
sub MkIO()
{
my $RxData = &MkIOLine(); # Blocking Read for complete line
# Zeile decodieren
if ( substr ($RxData, 0, 1) eq '#' )
{
# Zeile decodieren
$Header = substr($RxData, 0, 3);
$Chksum = substr($RxData, -2);
$Data = substr($RxData, 3, length ($RxData) -5);
# CRC prüfen
if ( &CrcCheck ("$Header" . "$Data", $Chksum ) )
{
# Base64 decodieren
$Data = &Decode64($Data);
# Daten auswerten und in shared Hash schreiben
if ( &ProcessRx($Header, $Data) )
{
return 1; # alles OK
}
}
}
return 0; # keine Daten empfangen
}
# Send a command to MK
sub MkSend()
{
my ($Id, $Addr, $Data) = @_;
# Init serial port
&MkInit();
my $Base64Data = &Encode64($Data);
my $TxData = "#" . "$Addr" . "$Id" . "$Base64Data";
my $Crc = &Crc($TxData);
my $TxSend = "$TxData" . "$Crc" . "\r";
$MkPort->write($TxSend);
}
# close COM-Port
sub MkClose()
{
undef $MkPort;
}
# CRC Prüfung
sub CrcCheck ()
{
my ($Data, $Crc) = @_;
my $Check = &Crc($Data);
if ( $Check ne $Crc )
{
return 0; # CRC passt nicht
}
return (1); # CRC OK
}
# CRC berechnen
sub Crc ()
{
my ($Data) = @_;
my $TmpCrc = 0;
my $Len = length $Data;
for ($i=0; $i<$Len; $i++)
{
$TmpCrc += ord(substr($Data, $i, 1));
}
$TmpCrc %= 4096;
my $Crc1 = ord ("=") + $TmpCrc / 64;
my $Crc2 = ord ("=") + $TmpCrc % 64;
$Crc = pack("CC", $Crc1, $Crc2);
return ($Crc);
}
# Empfangene Daten decodieren, modifiziertes Base64
sub Decode64()
{
my ($DataIn) = @_;
my $ptrIn = 0;
my $DataOut = "";
my $len = length ($DataIn);
while ( $len > 0 )
{
$a = ord (substr ($DataIn, $ptrIn ++, 1)) - ord ("=");
$b = ord (substr ($DataIn, $ptrIn ++, 1)) - ord ("=");
$c = ord (substr ($DataIn, $ptrIn ++, 1)) - ord ("=");
$d = ord (substr ($DataIn, $ptrIn ++, 1)) - ord ("=");
$x = ($a << 2) | ($b >> 4);
$y = (($b & 0x0f) << 4) | ($c >> 2);
$z = (($c & 0x03) << 6) | $d;
foreach $i ( $x, $y, $z )
{
if ( $len--)
{
my $Tmp = pack ('C1', $i);
$DataOut = "$DataOut" . "$Tmp";
}
else
{
last;
}
}
}
return ($DataOut);
}
# zu sendende Daten codieren, modifiziertes Base64
sub Encode64()
{
my ($Data) = @_;
my $Length = length $Data;
my $TxBuf = "";
my $ptr = 0;
while( $Length > 0 )
{
my $a = 0;
my $b = 0;
my $c = 0;
if ($Length) {$a = ord(substr ($Data, $ptr++, $Length--));}
if ($Length) {$b = ord(substr ($Data, $ptr++, $Length--));}
if ($Length) {$c = ord(substr ($Data, $ptr++, $Length--));}
my $ac = ord("=") + ($a >> 2);
my $bc = ord("=") + ( (($a & 0x03) << 4) | (($b & 0xf0) >> 4) );
my $cc = ord("=") + ( (($b & 0x0f) << 2) | (($c & 0xc0) >> 6) );
my $dc = ord("=") + ($c & 0x3f);
$TxBuf = "$TxBuf" . pack ("C4", $ac, $bc, $cc, $dc);
}
return ($TxBuf);
}
# Empfangenen Datensatz verarbeiten
sub ProcessRx()
{
my ($Header, $Data) = @_;
my $Adr = substr ($Header, 1, 1); # b=FC, c=NC, d=MK3MAG
my $Id = substr ($Header, 2, 1);
if ( $Id eq "O" )
{
#
# OSD-Daten nach %MkOsd einlesen
#
# Struktur Datensatz:
# u8 Version // version of the data structure
# GPS_Pos_t CurrentPosition;
# GPS_Pos_t TargetPosition;
# GPS_PosDev_t TargetPositionDeviation;
# GPS_Pos_t HomePosition;
# GPS_PosDev_t HomePositionDeviation;
# u8 WaypointIndex; // index of current waypoints running from 0 to WaypointNumber-1
# u8 WaypointNumber; // number of stored waypoints
# u8 SatsInUse; // no of satellites used for position solution
# s16 Altimeter; // hight according to air pressure
# s16 Variometer; // climb(+) and sink(-) rate
# u16 FlyingTime; // in seconds
# u8 UBat; // Battery Voltage in 0.1 Volts
# u16 GroundSpeed; // speed over ground in cm/s (2D)
# s16 Heading; // current flight direction in deg as angle to north
# s16 CompassHeading; // current compass value
# s8 AngleNick; // current Nick angle in 1°
# s8 AngleRoll; // current Rick angle in 1°
# u8 RC_Quality; // RC_Quality
# u8 MKFlags; // Flags from FC
# u8 NCFlags; // Flags from NC
# u8 Errorcode; // 0 --> okay
# u8 OperatingRadius // current operation radius around the Home Position in m
# s16 TopSpeed; // velocity in vertical direction in cm/s
# u8 TargetHoldTime; // time in s to stay at the given target, counts down to 0 if target has been reached
# u8 RC_RSSI; // Receiver signal strength (since version 2 added)
# s16 SetpointAltitude; // setpoint for altitude
# u8 Gas; // for future use
# u16 Current; // actual current in 0.1A steps
# u16 UsedCapacity; // used capacity in mAh
# GPS_Pos_t:
# s32 Longitude; // in 1E-7 deg
# s32 Latitude; // in 1E-7 deg
# s32 Altitude; // in mm
# u8 Status; // validity of data
# GPS_PosDev_t:
# s16 Distance; // distance to target in dm
# s16 Bearing; // course to target in deg
# Status:
# INVALID = 0
# NEWDATA = 1
# PROCESSED = 2
# MKFlags 0x01: MOTOR_RUN, 0x02 FLY, 0x04: CALIBRATE, 0x08: START, 0x10: EMERGENCY_LANDING
# NCFlags 0x01: FLAG_FREE, 0x02: FLAG_PH, 0x04: FLAG_CH, 0x08: FLAG_RANGE_LIMIT
# 0x10: FLAG_NOSERIALLINK, 0x20: FLAG_TARGET_REACHED, FLAG_MANUAL_CONTROL: 0x40
# 0x80: FLAG_8
lock (%MkOsd); # until end of Block
(
$MkOsd{'Version'},
$MkOsd{'CurPos_Lon'},
$MkOsd{'CurPos_Lat'},
$MkOsd{'CurPos_Alt'},
$MkOsd{'CurPos_Stat'},
$MkOsd{'TargetPos_Lon'},
$MkOsd{'TargetPos_Lat'},
$MkOsd{'TargetPos_Alt'},
$MkOsd{'TargetPos_Stat'},
$MkOsd{'TargetPosDev_Dist'},
$MkOsd{'TargetPosDev_Bearing'},
$MkOsd{'HomePos_Lon'},
$MkOsd{'HomePos_Lat'},
$MkOsd{'HomePos_Alt'},
$MkOsd{'HomePos_Stat'},
$MkOsd{'HomePosDev_Dist'},
$MkOsd{'HomePosDev_Bearing'},
$MkOsd{'WaypointIndex'},
$MkOsd{'WaypointNumber'},
$MkOsd{'SatsInUse'},
$MkOsd{'Altimeter'},
$MkOsd{'Variometer'},
$MkOsd{'FlyingTime'},
$MkOsd{'UBat'},
$MkOsd{'GroundSpeed'},
$MkOsd{'Heading'},
$MkOsd{'CompassHeading'},
$MkOsd{'AngleNick'},
$MkOsd{'AngleRoll'},
$MkOsd{'RC_Quality'},
$MkOsd{'MKFlags'},
$MkOsd{'NCFlags'},
$MkOsd{'Errorcode'},
$MkOsd{'OperatingRadius'},
$MkOsd{'TopSpeed'},
$MkOsd{'TargetHoldTime'},
$MkOsd{'RC_RSSI'},
$MkOsd{'SetPointAltitude'},
$MkOsd{'Gas'},
$MkOsd{'Current'},
$MkOsd{'UsedCapacity'},
) = unpack ('ClllClllCsslllCssCCCssSCSssccCCCCCsCCsCSS', $Data);
$MkOsd{'CurPos_Lon'} = sprintf("%.7f", $MkOsd{'CurPos_Lon'} / 10000000);
$MkOsd{'CurPos_Lat'} = sprintf("%.7f", $MkOsd{'CurPos_Lat'} / 10000000);
$MkOsd{'CurPos_Alt'} = sprintf("%.3f", $MkOsd{'CurPos_Alt'} / 1000);
$MkOsd{'TargetPos_Lon'} = sprintf("%.7f", $MkOsd{'TargetPos_Lon'} / 10000000);
$MkOsd{'TargetPos_Lat'} = sprintf("%.7f", $MkOsd{'TargetPos_Lat'} / 10000000);
$MkOsd{'TargetPos_Alt'} = sprintf("%.3f", $MkOsd{'TargetPos_Alt'} / 1000);
$MkOsd{'HomePos_Lon'} = sprintf("%.7f", $MkOsd{'HomePos_Lon'} / 10000000);
$MkOsd{'HomePos_Lat'} = sprintf("%.7f", $MkOsd{'HomePos_Lat'} / 10000000);
$MkOsd{'HomePos_Alt'} = sprintf("%.3f", $MkOsd{'HomePos_Alt'} / 1000);
$MkOsd{'UBat'} = sprintf("%.1f", $MkOsd{'UBat'} / 10);
$MkOsd{'Current'} = sprintf("%.1f", $MkOsd{'Current'} / 10);
# Timestamp, wann der Datensatz geschtieben wurde
$MkOsd{'_Timestamp'} = time;
}
elsif ( $Id eq "s" )
{
#
# NC Target position in %MkTarget
#
# Datenstruktur:
# GPS_Pos_t Position; // the gps position of the waypoint, see ubx.h for details
# s16 Heading; // orientation, future implementation
# u8 ToleranceRadius; // in meters, if the MK is within that range around the target, then the next target is
# u8 HoldTime; // in seconds, if the MK was once in the tolerance area around a WP,
# // this time defines the delay before the next WP is triggered
# u8 Event_Flag; // future emplementation
# u8 reserve[12]; // reserved
lock (%MkTarget); # until end of block
(
$MkTarget{'Pos_Lon'},
$MkTarget{'Pos_Lat'},
$MkTarget{'Pos_Alt'},
$MkTarget{'Pos_Stat'},
$MkTarget{'Heading'},
$MkTarget{'ToleranceRadius'},
$MkTarget{'HoldTime'},
$MkTarget{'EventFlag'},
) = unpack ('lllCsCCC', $Data);
$MkTarget{'Pos_Lon'} = sprintf("%.7f", $MkTarget{'Pos_Lon'} / 10000000);
$MkTarget{'Pos_Lat'} = sprintf("%.7f", $MkTarget{'Pos_Lat'} / 10000000);
$MkTarget{'Pos_Alt'} = sprintf("%.3f", $MkTarget{'Pos_Alt'} / 1000);
# Timestamp, wann der Datensatz geschrieben wurde
$MkTarget{'_Timestamp'} = time;
}
elsif ( $Id eq "W" )
{
#
# Request new waypoint
#
# Datenstruktur:
# u8 Number of waypoint
($WpNumber) = unpack ('C', $Data);
# keine Ahnung wofuer das gut sein soll
# print "Request new Waypoint Number: $WpNumber\n";
}
elsif ( $Id eq "V" )
{
#
# Version
#
# Datenstruktur:
# u8 SWMajor
# u8 SWMinor
# u8 ProtoMajor
# u8 ProtoMinor
# u8 SWPatch
# u8 Reserved[5]
(
$Mk{'SWMajor'},
$Mk{'SWMinor'},
$Mk{'ProtoMajor'},
$Mk{'ProtoMinor'},
$Mk{'SWPatch'},
) = unpack ('C5', $Data);
$Mk{'_Timestamp'} = time;
}
elsif ( $Id eq "E" )
{
#
# Error Text
#
# Datenstruktur:
# s8 ErrorMsg[25]
$Mk{'ErrorMsg'} = unpack ('Z25', $Data);
}
elsif ( $Id eq "D" )
{
#
# NC Debug %MkNcDebug
#
# Datenstruktur:
# u8 Digital[2];
# u16 Analog[32];
lock (%MkNcDebug); # until end of block
(
$MkNcDebug{'Digital_00'},
$MkNcDebug{'Digital_01'},
$MkNcDebug{'Analog_00'},
$MkNcDebug{'Analog_01'},
$MkNcDebug{'Analog_02'},
$MkNcDebug{'Analog_03'},
$MkNcDebug{'Analog_04'},
$MkNcDebug{'Analog_05'},
$MkNcDebug{'Analog_06'},
$MkNcDebug{'Analog_07'},
$MkNcDebug{'Analog_08'},
$MkNcDebug{'Analog_09'},
$MkNcDebug{'Analog_10'},
$MkNcDebug{'Analog_11'},
$MkNcDebug{'Analog_12'},
$MkNcDebug{'Analog_13'},
$MkNcDebug{'Analog_14'},
$MkNcDebug{'Analog_15'},
$MkNcDebug{'Analog_16'},
$MkNcDebug{'Analog_17'},
$MkNcDebug{'Analog_18'},
$MkNcDebug{'Analog_19'},
$MkNcDebug{'Analog_20'},
$MkNcDebug{'Analog_21'},
$MkNcDebug{'Analog_22'},
$MkNcDebug{'Analog_23'},
$MkNcDebug{'Analog_24'},
$MkNcDebug{'Analog_25'},
$MkNcDebug{'Analog_26'},
$MkNcDebug{'Analog_27'},
$MkNcDebug{'Analog_28'},
$MkNcDebug{'Analog_29'},
$MkNcDebug{'Analog_30'},
$MkNcDebug{'Analog_31'},
) = unpack ('C2s32', $Data);
# Timestamp, wann der Datensatz geschrieben wurde
$MkNcDebug{'_Timestamp'} = time;
}
elsif ( $Id eq "B" )
{
#
# External Control
#
# Datenstruktur:
# u8 ConfirmFrame;
my ($ConfirmFrame) = unpack ('C5', $Data);
}
else
{
print "Unknown Command: $Header $Data\n";
}
}
# send Target or Waypoint to MK
sub MkFlyTo()
{
my %Param = @_;
my $x = $Param{'-x'};
my $y = $Param{'-y'};
my $Lat = $Param{'-lat'};
my $Lon = $Param{'-lon'};
my $Alt = $Param{'-alt'};
my $Heading = $Param{'-heading'};
my $ToleranceRadius = $Param{'-toleranceradius'};
my $Holdtime = $Param{'-holdtime'};
my $EventFlag = $Param{'-eventflag'};
my $Mode = $Param{'-mode'};
my $Index = $Param{'-index'}; # 1..n
if ( $x ne "" and $y ne "" and $Lat eq "" and $Lon eq "" )
{
($Lat, $Lon) = &MapXY2Gps($x, $y);
}
if ( $Alt eq "" ) { $Alt = $MkOsd{'CurPos_Alt'}; }
if ( $Heading eq "" ) { $Heading = $Cfg->{'waypoint'}->{'DefaultHeading'}; }
if ( $ToleranceRadius eq "" ) { $ToleranceRadius = $Cfg->{'waypoint'}->{'DefaultToleranceRadius'}; }
if ( $Holdtime eq "" ) { $Holdtime = $Cfg->{'waypoint'}->{'DefaultHoldtime'}; }
if ( $EventFlag eq "" ) { $EventFlag = $Cfg->{'waypoint'}->{'DefaultEventFlag'}; }
my $Status = 1; # valid
if ( $Mode =~ /delete/i )
{
$Status = 0; # invalid -> delete NC WP-List
}
my $Lat_i = sprintf "%d", $Lat * 10000000;
my $Lon_i = sprintf "%d", $Lon * 10000000;
my $Alt_i = sprintf "%d", $Alt * 1000;
# Datenstruktur:
# GPS_Pos_t Position; // the gps position of the waypoint, see ubx.h for details
# s16 Heading; // orientation, future implementation
# u8 ToleranceRadius; // in meters, if the MK is within that range around the target, then the next target is
# u8 HoldTime; // in seconds, if the MK was once in the tolerance area around a WP,
# // this time defines the delay before the next WP is triggered
# u8 Event_Flag; // future emplementation
# u8 Index; // to indentify different waypoints, workaround for bad communications PC <-> NC
# u8 reserve[11]; // reserved
my $Wp = pack ('lllCsC15',
$Lon_i,
$Lat_i,
$Alt_i,
$Status,
$Heading,
$ToleranceRadius,
$Holdtime,
$EventFlag,
$Index + 1,
0,0,0,0,0,0,0,0,0,0,0,
);
if ( $Mode =~ /waypoint/i )
{
$MkSendQueue->enqueue( "w", "$AddrNC", $Wp );
# &MkSend( "w", "$AddrNC", $Wp );
}
elsif ( $Mode =~ /target/i )
{
$MkSendQueue->enqueue( "s", "$AddrNC", $Wp );
# &MkSend( "s", "$AddrNC", $Wp );
# set Target information for Simulator
$MkSim{'Target_Lat'} = $Lat;
$MkSim{'Target_Lon'} = $Lon;
$MkSim{'Target_Alt'} = $Alt;
$MkSim{'Target_Status'} = $Status;
$MkSim{'Target_Heading'} = $Heading;
$MkSim{'Target_ToleranceRadius'} = $ToleranceRadius;
$MkSim{'Target_Holdtime'} = $Holdtime;
$MkSim{'Target_EventFlag'} = $EventFlag;
# Timestamp, wann der Datensatz geschtieben wurde
$MkSim{'_Timestamp'} = time;
}
else
{
# ignore
}
return 0;
}
# send External control to MK
sub SendExternalControl()
{
my %Param = @_;
my $RemoteButtons = $Param{'-remotebuttons'};
my $Nick = $Param{'-nick'};
my $Roll = $Param{'-roll'};
my $Gier = $Param{'-gier'};
my $Gas = $Param{'-gas'};
my $Hight = $Param{'-hight'};
my $Free = $Param{'-free'};
my $Frame = $Param{'-frame'};
my $Config = $Param{'-config'};
# Datenstruktur:
# u8 Digital[2];
# u8 RemoteButtons;
# s8 Nick;
# s8 Roll;
# s8 Yaw;
# u8 Gas;
# s8 Height;
# u8 free;
# u8 Frame;
# u8 Config;
# Config/Bit 0 and FC-Parameter ExternControl > 128:
# Nich/Roll/Yaw added to RC-Channel
# Gas wird auf max. RC-Gas begrenzt
my $Ec = pack ('CCCcccCcCCC',
0, 0,
$RemoteButtons,
$Nick,
$Roll,
$Gier,
$Gas,
$Hight,
$Free,
$Frame, # Frame/Command counter, ungleich 0
$Config,
);
$MkSendQueue->enqueue( "b", "$AddrFC", $Ec );
# &MkSend( "b", "$AddrFC", $Ec );
return 0;
}
# send serial Channel values from %MkSerialChannel to MK/FC
sub SendSerialChannel()
{
# Datenstruktur:
# s8 Channel[12];
lock (%MkSerialChannel); # until end of block
my $SP = pack ('c12',
$MkSerialChannel{'SerialChannel01'},
$MkSerialChannel{'SerialChannel02'},
$MkSerialChannel{'SerialChannel03'},
$MkSerialChannel{'SerialChannel04'},
$MkSerialChannel{'SerialChannel05'},
$MkSerialChannel{'SerialChannel06'},
$MkSerialChannel{'SerialChannel07'},
$MkSerialChannel{'SerialChannel08'},
$MkSerialChannel{'SerialChannel09'},
$MkSerialChannel{'SerialChannel10'},
$MkSerialChannel{'SerialChannel11'},
$MkSerialChannel{'SerialChannel12'},
);
$MkSendQueue->enqueue( "y", "$AddrFC", $SP );
# &MkSend( "y", "$AddrFC", $SP );
return 0;
}
# when called as thread
sub MkCommLoop()
{
while (1)
{
&MkIO();
}
}
#
# Hauptprgramm
#
if ( $0 =~ /mkcomm.pl$/i )
{
# Program wurde direkt aufgerufen
&MkCommLoop();
# should never exit
}
1;
__END__

/MissionCockpit/tags/V0.4.0/perl/InstallPackages.bat
0,0 → 1,24
echo off
echo Download and Installation of required Perl Packages
call ppm install Tk
call ppm install Tk::Balloon
call ppm install Tk::Dialog
call ppm install Tk::Notebook
call ppm install Tk::JPEG
call ppm install Tk::PNG
call ppm install Math::Trig
call ppm install XML::Simple
call ppm install Geo::Ellipsoid
call ppm install threads
call ppm install threads::shared
call ppm install Thread::Queue
call ppm install Time::Hires
rem call ppm install Win32::SerialPort
call ppm install Win32::Locale
call ppm install Clipboard
call ppm install Spiffy
call ppm install Image::Size
call ppm install Win32::MultiMedia::Joystick
echo done

/MissionCockpit/tags/V0.4.0/perl/lib/Win32/SerialPort.pm
0,0 → 1,2969
package Win32::SerialPort;
use Win32;
use Win32API::CommPort qw( :STAT :PARAM 0.17 );
use Carp;
use strict;
use vars qw($VERSION @ISA @EXPORT @EXPORT_OK %EXPORT_TAGS);
$VERSION = '0.19';
require Exporter;
## require AutoLoader;
@ISA = qw( Exporter Win32API::CommPort );
# Items to export into callers namespace by default. Note: do not export
# names by default without a very good reason. Use EXPORT_OK instead.
# Do not simply export all your public functions/methods/constants.
@EXPORT= qw();
@EXPORT_OK= @Win32API::CommPort::EXPORT_OK;
%EXPORT_TAGS = %Win32API::CommPort::EXPORT_TAGS;
# parameters that must be included in a "save" and "checking subs"
my %validate = (
ALIAS => "alias",
BAUD => "baudrate",
BINARY => "binary",
DATA => "databits",
E_MSG => "error_msg",
EOFCHAR => "eof_char",
ERRCHAR => "error_char",
EVTCHAR => "event_char",
HSHAKE => "handshake",
PARITY => "parity",
PARITY_EN => "parity_enable",
RCONST => "read_const_time",
READBUF => "set_read_buf",
RINT => "read_interval",
RTOT => "read_char_time",
STOP => "stopbits",
U_MSG => "user_msg",
WCONST => "write_const_time",
WRITEBUF => "set_write_buf",
WTOT => "write_char_time",
XOFFCHAR => "xoff_char",
XOFFLIM => "xoff_limit",
XONCHAR => "xon_char",
XONLIM => "xon_limit",
intr => "is_stty_intr",
quit => "is_stty_quit",
s_eof => "is_stty_eof",
eol => "is_stty_eol",
erase => "is_stty_erase",
s_kill => "is_stty_kill",
bsdel => "stty_bsdel",
clear => "is_stty_clear",
echo => "stty_echo",
echoe => "stty_echoe",
echok => "stty_echok",
echonl => "stty_echonl",
echoke => "stty_echoke",
echoctl => "stty_echoctl",
istrip => "stty_istrip",
icrnl => "stty_icrnl",
ocrnl => "stty_ocrnl",
opost => "stty_opost",
igncr => "stty_igncr",
inlcr => "stty_inlcr",
onlcr => "stty_onlcr",
isig => "stty_isig",
icanon => "stty_icanon",
DVTYPE => "devicetype",
HNAME => "hostname",
HADDR => "hostaddr",
DATYPE => "datatype",
CFG_1 => "cfg_param_1",
CFG_2 => "cfg_param_2",
CFG_3 => "cfg_param_3",
);
# parameters supported by the stty method
my %opts = ( "intr" => "is_stty_intr:argv_char",
"quit" => "is_stty_quit:argv_char",
"eof" => "is_stty_eof:argv_char",
"eol" => "is_stty_eol:argv_char",
"erase" => "is_stty_erase:argv_char",
"kill" => "is_stty_kill:argv_char",
"echo" => "stty_echo:1",
"-echo" => "stty_echo:0",
"echoe" => "stty_echoe:1",
"-echoe" => "stty_echoe:0",
"echok" => "stty_echok:1",
"-echok" => "stty_echok:0",
"echonl" => "stty_echonl:1",
"-echonl" => "stty_echonl:0",
"echoke" => "stty_echoke:1",
"-echoke" => "stty_echoke:0",
"echoctl" => "stty_echoctl:1",
"-echoctl" => "stty_echoctl:0",
"istrip" => "stty_istrip:1",
"-istrip" => "stty_istrip:0",
"icrnl" => "stty_icrnl:1",
"-icrnl" => "stty_icrnl:0",
"ocrnl" => "stty_ocrnl:1",
"-ocrnl" => "stty_ocrnl:0",
"igncr" => "stty_igncr:1",
"-igncr" => "stty_igncr:0",
"inlcr" => "stty_inlcr:1",
"-inlcr" => "stty_inlcr:0",
"onlcr" => "stty_onlcr:1",
"-onlcr" => "stty_onlcr:0",
"opost" => "stty_opost:1",
"-opost" => "stty_opost:0",
"isig" => "stty_isig:1",
"-isig" => "stty_isig:0",
"icanon" => "stty_icanon:1",
"-icanon" => "stty_icanon:0",
"parenb" => "parity_enable:1",
"-parenb" => "parity_enable:0",
"inpck" => "parity_enable:1",
"-inpck" => "parity:none",
"cs5" => "databits:5",
"cs6" => "databits:6",
"cs7" => "databits:7",
"cs8" => "databits:8",
"cstopb" => "stopbits:2",
"-cstopb" => "stopbits:1",
"parodd" => "parity:odd",
"-parodd" => "parity:even",
"clocal" => "handshake:none",
"-clocal" => "handshake:dtr",
"crtscts" => "handshake:rts",
"-crtscts" => "handshake:none",
"ixon" => "handshake:xoff",
"-ixon" => "handshake:none",
"ixoff" => "handshake:xoff",
"-ixoff" => "handshake:none",
"start" => "xon_char:argv_char",
"stop" => "xoff_char:argv_char",
);
#### Package variable declarations ####
my @binary_opt = (0, 1);
my @byte_opt = (0, 255);
my $cfg_file_sig="Win32::SerialPort_Configuration_File -- DO NOT EDIT --\n";
my $Verbose = 0;
# test*.t only - suppresses default messages
sub set_test_mode_active {
return unless (@_ == 2);
Win32API::CommPort->set_no_messages($_[1]);
# object not defined but :: upsets strict
return (keys %validate);
}
sub new {
my $proto = shift;
my $class = ref($proto) || $proto;
my $device = shift;
my @new_cmd = ($device);
my $quiet = shift;
if ($quiet) {
push @new_cmd, 1;
}
my $self = $class->SUPER::new(@new_cmd);
unless ($self) {
return 0 if ($quiet);
return;
}
# "private" data
$self->{"_DEBUG"} = 0;
$self->{U_MSG} = 0;
$self->{E_MSG} = 0;
$self->{OFS} = "";
$self->{ORS} = "";
$self->{"_T_INPUT"} = "";
$self->{"_LOOK"} = "";
$self->{"_LASTLOOK"} = "";
$self->{"_LASTLINE"} = "";
$self->{"_CLASTLINE"} = "";
$self->{"_SIZE"} = 1;
$self->{"_LMATCH"} = "";
$self->{"_LPATT"} = "";
$self->{"_PROMPT"} = "";
$self->{"_MATCH"} = [];
$self->{"_CMATCH"} = [];
@{ $self->{"_MATCH"} } = "\n";
@{ $self->{"_CMATCH"} } = "\n";
$self->{DVTYPE} = "none";
$self->{HNAME} = "localhost";
$self->{HADDR} = 0;
$self->{DATYPE} = "raw";
$self->{CFG_1} = "none";
$self->{CFG_2} = "none";
$self->{CFG_3} = "none";
# user settable options for lookfor (the "stty" collection)
# defaults like RedHat linux unless indicated
# char to abort nextline subroutine
$self->{intr} = "\cC"; # MUST be single char
# char to abort perl
$self->{quit} = "\cD"; # MUST be single char
# end_of_file char (linux typ: "\cD")
$self->{s_eof} = "\cZ"; # MUST be single char
# end_of_line char
$self->{eol} = "\cJ"; # MUST be single char
# delete one character from buffer (backspace)
$self->{erase} = "\cH"; # MUST be single char
# clear line buffer
$self->{s_kill} = "\cU"; # MUST be single char
# written after erase character
$self->{bsdel} = "\cH \cH";
# written after kill character
my $space76 = " "x76;
$self->{clear} = "\r$space76\r"; # 76 spaces
# echo every character
$self->{echo} = 0;
# echo erase character with bsdel string
$self->{echoe} = 1;
# echo \n after kill character
$self->{echok} = 1;
# echo \n
$self->{echonl} = 0;
# echo clear string after kill character
$self->{echoke} = 1; # linux console yes, serial no
# echo "^Char" for control chars
$self->{echoctl} = 0; # linux console yes, serial no
# strip input to 7-bits
$self->{istrip} = 0;
# map \r to \n on input
$self->{icrnl} = 0;
# map \r to \n on output
$self->{ocrnl} = 0;
# ignore \r on input
$self->{igncr} = 0;
# map \n to \r on input
$self->{inlcr} = 0;
# map \n to \r\n on output
$self->{onlcr} = 1;
# enable output mapping
$self->{opost} = 0;
# enable quit and intr characters
$self->{isig} = 0; # linux actually SUPPORTS signals
# enable erase and kill characters
$self->{icanon} = 0;
my $token;
my @bauds = $self->are_baudrate;
foreach $token (@bauds) { $opts{$token} = "baudrate:$token"; }
# initialize (in CommPort) and write_settings need these defined
$self->{"_N_U_MSG"} = 0;
$self->{"_N_E_MSG"} = 0;
$self->{"_N_ALIAS"} = 0;
$self->{"_N_intr"} = 0;
$self->{"_N_quit"} = 0;
$self->{"_N_s_eof"} = 0;
$self->{"_N_eol"} = 0;
$self->{"_N_erase"} = 0;
$self->{"_N_s_kill"} = 0;
$self->{"_N_bsdel"} = 0;
$self->{"_N_clear"} = 0;
$self->{"_N_echo"} = 0;
$self->{"_N_echoe"} = 0;
$self->{"_N_echok"} = 0;
$self->{"_N_echonl"} = 0;
$self->{"_N_echoke"} = 0;
$self->{"_N_echoctl"} = 0;
$self->{"_N_istrip"} = 0;
$self->{"_N_icrnl"} = 0;
$self->{"_N_ocrnl"} = 0;
$self->{"_N_opost"} = 0;
$self->{"_N_igncr"} = 0;
$self->{"_N_inlcr"} = 0;
$self->{"_N_onlcr"} = 0;
$self->{"_N_isig"} = 0;
$self->{"_N_icanon"} = 0;
$self->{"_N_DVTYPE"} = 0;
$self->{"_N_HNAME"} = 0;
$self->{"_N_HADDR"} = 0;
$self->{"_N_DATYPE"} = 0;
$self->{"_N_CFG_1"} = 0;
$self->{"_N_CFG_2"} = 0;
$self->{"_N_CFG_3"} = 0;
$self->{ALIAS} = $device; # so "\\.\+++" can be changed
$self->{DEVICE} = $device; # clone so NAME stays in CommPort
($self->{MAX_RXB}, $self->{MAX_TXB}) = $self->buffer_max;
bless ($self, $class);
return $self;
}
sub stty_intr {
my $self = shift;
if (@_ == 1) { $self->{intr} = shift; }
return if (@_);
return $self->{intr};
}
sub stty_quit {
my $self = shift;
if (@_ == 1) { $self->{quit} = shift; }
return if (@_);
return $self->{quit};
}
sub is_stty_eof {
my $self = shift;
if (@_ == 1) { $self->{s_eof} = chr(shift); }
return if (@_);
return ord($self->{s_eof});
}
sub is_stty_eol {
my $self = shift;
if (@_ == 1) { $self->{eol} = chr(shift); }
return if (@_);
return ord($self->{eol});
}
sub is_stty_quit {
my $self = shift;
if (@_ == 1) { $self->{quit} = chr(shift); }
return if (@_);
return ord($self->{quit});
}
sub is_stty_intr {
my $self = shift;
if (@_ == 1) { $self->{intr} = chr(shift); }
return if (@_);
return ord($self->{intr});
}
sub is_stty_erase {
my $self = shift;
if (@_ == 1) { $self->{erase} = chr(shift); }
return if (@_);
return ord($self->{erase});
}
sub is_stty_kill {
my $self = shift;
if (@_ == 1) { $self->{s_kill} = chr(shift); }
return if (@_);
return ord($self->{s_kill});
}
sub is_stty_clear {
my $self = shift;
my @chars;
if (@_ == 1) {
@chars = split (//, shift);
for (@chars) {
$_ = chr ( ord($_) - 32 );
}
$self->{clear} = join("", @chars);
return $self->{clear};
}
return if (@_);
@chars = split (//, $self->{clear});
for (@chars) {
$_ = chr ( ord($_) + 32 );
}
my $permute = join("", @chars);
return $permute;
}
sub stty_eof {
my $self = shift;
if (@_ == 1) { $self->{s_eof} = shift; }
return if (@_);
return $self->{s_eof};
}
sub stty_eol {
my $self = shift;
if (@_ == 1) { $self->{eol} = shift; }
return if (@_);
return $self->{eol};
}
sub stty_erase {
my $self = shift;
if (@_ == 1) {
my $tmp = shift;
return unless (length($tmp) == 1);
$self->{erase} = $tmp;
}
return if (@_);
return $self->{erase};
}
sub stty_kill {
my $self = shift;
if (@_ == 1) {
my $tmp = shift;
return unless (length($tmp) == 1);
$self->{s_kill} = $tmp;
}
return if (@_);
return $self->{s_kill};
}
sub stty_bsdel {
my $self = shift;
if (@_ == 1) { $self->{bsdel} = shift; }
return if (@_);
return $self->{bsdel};
}
sub stty_clear {
my $self = shift;
if (@_ == 1) { $self->{clear} = shift; }
return if (@_);
return $self->{clear};
}
sub stty_echo {
my $self = shift;
if (@_ == 1) { $self->{echo} = yes_true ( shift ) }
return if (@_);
return $self->{echo};
}
sub stty_echoe {
my $self = shift;
if (@_ == 1) { $self->{echoe} = yes_true ( shift ) }
return if (@_);
return $self->{echoe};
}
sub stty_echok {
my $self = shift;
if (@_ == 1) { $self->{echok} = yes_true ( shift ) }
return if (@_);
return $self->{echok};
}
sub stty_echonl {
my $self = shift;
if (@_ == 1) { $self->{echonl} = yes_true ( shift ) }
return if (@_);
return $self->{echonl};
}
sub stty_echoke {
my $self = shift;
if (@_ == 1) { $self->{echoke} = yes_true ( shift ) }
return if (@_);
return $self->{echoke};
}
sub stty_echoctl {
my $self = shift;
if (@_ == 1) { $self->{echoctl} = yes_true ( shift ) }
return if (@_);
return $self->{echoctl};
}
sub stty_istrip {
my $self = shift;
if (@_ == 1) { $self->{istrip} = yes_true ( shift ) }
return if (@_);
return $self->{istrip};
}
sub stty_icrnl {
my $self = shift;
if (@_ == 1) { $self->{icrnl} = yes_true ( shift ) }
return if (@_);
return $self->{icrnl};
}
sub stty_ocrnl {
my $self = shift;
if (@_ == 1) { $self->{ocrnl} = yes_true ( shift ) }
return if (@_);
return $self->{ocrnl};
}
sub stty_opost {
my $self = shift;
if (@_ == 1) { $self->{opost} = yes_true ( shift ) }
return if (@_);
return $self->{opost};
}
sub stty_igncr {
my $self = shift;
if (@_ == 1) { $self->{igncr} = yes_true ( shift ) }
return if (@_);
return $self->{igncr};
}
sub stty_inlcr {
my $self = shift;
if (@_ == 1) { $self->{inlcr} = yes_true ( shift ) }
return if (@_);
return $self->{inlcr};
}
sub stty_onlcr {
my $self = shift;
if (@_ == 1) { $self->{onlcr} = yes_true ( shift ) }
return if (@_);
return $self->{onlcr};
}
sub stty_isig {
my $self = shift;
if (@_ == 1) { $self->{isig} = yes_true ( shift ) }
return if (@_);
return $self->{isig};
}
sub stty_icanon {
my $self = shift;
if (@_ == 1) { $self->{icanon} = yes_true ( shift ) }
return if (@_);
return $self->{icanon};
}
sub is_prompt {
my $self = shift;
if (@_ == 1) { $self->{"_PROMPT"} = shift; }
return if (@_);
return $self->{"_PROMPT"};
}
sub are_match {
my $self = shift;
my $pat;
my $patno = 0;
my $reno = 0;
my $re_next = 0;
if (@_) {
@{ $self->{"_MATCH"} } = @_;
if ($] >= 5.005) {
@{ $self->{"_CMATCH"} } = ();
while ($pat = shift) {
if ($re_next) {
$re_next = 0;
eval 'push (@{ $self->{"_CMATCH"} }, qr/$pat/)';
} else {
push (@{ $self->{"_CMATCH"} }, $pat);
}
if ($pat eq "-re") {
$re_next++;
}
}
} else {
@{ $self->{"_CMATCH"} } = @_;
}
}
return @{ $self->{"_MATCH"} };
}
# parse values for start/restart
sub get_start_values {
return unless (@_ == 2);
my $self = shift;
my $filename = shift;
unless ( open CF, "<$filename" ) {
carp "can't open file: $filename";
return;
}
my ($signature, $name, @values) = <CF>;
close CF;
unless ( $cfg_file_sig eq $signature ) {
carp "Invalid signature in $filename: $signature";
return;
}
chomp $name;
unless ( $self->{DEVICE} eq $name ) {
carp "Invalid Port DEVICE=$self->{DEVICE} in $filename: $name";
return;
}
if ($Verbose or not $self) {
print "signature = $signature";
print "name = $name\n";
if ($Verbose) {
print "values:\n";
foreach (@values) { print " $_"; }
}
}
my $item;
my $key;
my $value;
my $gosub;
my $fault = 0;
no strict 'refs'; # for $gosub
foreach $item (@values) {
chomp $item;
($key, $value) = split (/,/, $item);
if ($value eq "") { $fault++ }
else {
$gosub = $validate{$key};
unless (defined &$gosub ($self, $value)) {
carp "Invalid parameter for $key=$value ";
return;
}
}
}
use strict 'refs';
if ($fault) {
carp "Invalid value in $filename";
undef $self;
return;
}
1;
}
sub restart {
return unless (@_ == 2);
my $self = shift;
my $filename = shift;
unless ( $self->init_done ) {
carp "Can't restart before Port has been initialized";
return;
}
get_start_values($self, $filename);
write_settings($self);
}
sub start {
my $proto = shift;
my $class = ref($proto) || $proto;
return unless (@_);
my $filename = shift;
unless ( open CF, "<$filename" ) {
carp "can't open file: $filename";
return;
}
my ($signature, $name, @values) = <CF>;
close CF;
unless ( $cfg_file_sig eq $signature ) {
carp "Invalid signature in $filename: $signature";
return;
}
chomp $name;
my $self = new ($class, $name);
if ($Verbose or not $self) {
print "signature = $signature";
print "class = $class\n";
print "name = $name\n";
if ($Verbose) {
print "values:\n";
foreach (@values) { print " $_"; }
}
}
if ($self) {
if ( get_start_values($self, $filename) ) {
write_settings ($self);
}
else {
carp "Invalid value in $filename";
undef $self;
return;
}
}
return $self;
}
sub write_settings {
my $self = shift;
my @items = keys %validate;
# initialize returns number of faults
if ( $self->initialize(@items) ) {
unless (nocarp) {
carp "write_settings failed, closing port";
$self->close;
}
return;
}
$self->update_DCB;
if ($Verbose) {
print "writing settings to $self->{ALIAS}\n";
}
1;
}
sub save {
my $self = shift;
my $item;
my $getsub;
my $value;
return unless (@_);
unless ($self->init_done) {
carp "can't save until init_done";
return;
}
my $filename = shift;
unless ( open CF, ">$filename" ) {
carp "can't open file: $filename";
return;
}
print CF "$cfg_file_sig";
print CF "$self->{DEVICE}\n";
# used to "reopen" so must be DEVICE=NAME
no strict 'refs'; # for $gosub
while (($item, $getsub) = each %validate) {
chomp $getsub;
$value = scalar &$getsub($self);
print CF "$item,$value\n";
}
use strict 'refs';
close CF;
if ($Verbose) {
print "wrote file $filename for $self->{ALIAS}\n";
}
1;
}
##### tied FileHandle support
sub TIEHANDLE {
my $proto = shift;
my $class = ref($proto) || $proto;
return unless (@_);
my $self = start($class, shift);
return $self;
}
# WRITE this, LIST
# This method will be called when the handle is written to via the
# syswrite function.
sub WRITE {
return if (@_ < 3);
my $self = shift;
my $buf = shift;
my $len = shift;
my $offset = 0;
if (@_) { $offset = shift; }
my $out2 = substr($buf, $offset, $len);
return unless ($self->post_print($out2));
return length($out2);
}
# PRINT this, LIST
# This method will be triggered every time the tied handle is printed to
# with the print() function. Beyond its self reference it also expects
# the list that was passed to the print function.
sub PRINT {
my $self = shift;
return unless (@_);
my $ofs = $, ? $, : "";
if ($self->{OFS}) { $ofs = $self->{OFS}; }
my $ors = $\ ? $\ : "";
if ($self->{ORS}) { $ors = $self->{ORS}; }
my $output = join($ofs,@_);
$output .= $ors;
return $self->post_print($output);
}
sub output_field_separator {
my $self = shift;
my $prev = $self->{OFS};
if (@_) { $self->{OFS} = shift; }
return $prev;
}
sub output_record_separator {
my $self = shift;
my $prev = $self->{ORS};
if (@_) { $self->{ORS} = shift; }
return $prev;
}
sub post_print {
my $self = shift;
return unless (@_);
my $output = shift;
if ($self->stty_opost) {
if ($self->stty_ocrnl) { $output =~ s/\r/\n/osg; }
if ($self->stty_onlcr) { $output =~ s/\n/\r\n/osg; }
}
my $to_do = length($output);
my $done = 0;
my $written = 0;
while ($done < $to_do) {
my $out2 = substr($output, $done);
$written = $self->write($out2);
if (! defined $written) {
$^E = 1121; # ERROR_COUNTER_TIMEOUT
return;
}
return 0 unless ($written);
$done += $written;
}
$^E = 0;
1;
}
# PRINTF this, LIST
# This method will be triggered every time the tied handle is printed to
# with the printf() function. Beyond its self reference it also expects
# the format and list that was passed to the printf function.
sub PRINTF {
my $self = shift;
my $fmt = shift;
return unless ($fmt);
return unless (@_);
my $output = sprintf($fmt, @_);
$self->PRINT($output);
}
# READ this, LIST
# This method will be called when the handle is read from via the read
# or sysread functions.
sub READ {
return if (@_ < 3);
my $buf = \$_[1];
my ($self, $junk, $len, $offset) = @_;
unless (defined $offset) { $offset = 0; }
my $done = 0;
my $count_in = 0;
my $string_in = "";
my $in2 = "";
my $bufsize = $self->internal_buffer;
while ($done < $len) {
my $size = $len - $done;
if ($size > $bufsize) { $size = $bufsize; }
($count_in, $string_in) = $self->read($size);
if ($count_in) {
$in2 .= $string_in;
$done += $count_in;
$^E = 0;
}
elsif ($done) {
$^E = 0;
last;
}
else {
$^E = 1121; # ERROR_COUNTER_TIMEOUT
last;
}
}
my $tail = substr($$buf, $offset + $done);
my $head = substr($$buf, 0, $offset);
if ($self->{icrnl}) { $in2 =~ tr/\r/\n/; }
if ($self->{inlcr}) { $in2 =~ tr/\n/\r/; }
if ($self->{igncr}) { $in2 =~ s/\r//gos; }
$$buf = $head.$in2.$tail;
return $done if ($done);
return;
}
# READLINE this
# This method will be called when the handle is read from via <HANDLE>.
# The method should return undef when there is no more data.
sub READLINE {
my $self = shift;
return if (@_);
my $gotit = "";
my $match = "";
my $was;
if (wantarray) {
my @lines;
for (;;) {
$was = $self->reset_error;
if ($was) {
$^E = 1117; # ERROR_IO_DEVICE
return @lines if (@lines);
return;
}
if (! defined ($gotit = $self->streamline($self->{"_SIZE"}))) {
$^E = 1121; # ERROR_COUNTER_TIMEOUT
return @lines if (@lines);
return;
}
$match = $self->matchclear;
if ( ($gotit ne "") || ($match ne "") ) {
$^E = 0;
$gotit .= $match;
push (@lines, $gotit);
return @lines if ($gotit =~ /$self->{"_CLASTLINE"}/s);
}
}
}
else {
for (;;) {
$was = $self->reset_error;
if ($was) {
$^E = 1117; # ERROR_IO_DEVICE
return;
}
if (! defined ($gotit = $self->lookfor($self->{"_SIZE"}))) {
$^E = 1121; # ERROR_COUNTER_TIMEOUT
return;
}
$match = $self->matchclear;
if ( ($gotit ne "") || ($match ne "") ) {
$^E = 0;
return $gotit.$match; # traditional <HANDLE> behavior
}
}
}
}
# GETC this
# This method will be called when the getc function is called.
sub GETC {
my $self = shift;
my ($count, $in) = $self->read(1);
if ($count == 1) {
$^E = 0;
return $in;
}
else {
$^E = 1121; # ERROR_COUNTER_TIMEOUT
return;
}
}
# CLOSE this
# This method will be called when the handle is closed via the close
# function.
sub CLOSE {
my $self = shift;
my $success = $self->close;
if ($Verbose) { printf "CLOSE result:%d\n", $success; }
return $success;
}
# DESTROY this
# As with the other types of ties, this method will be called when the
# tied handle is about to be destroyed. This is useful for debugging and
# possibly cleaning up.
sub DESTROY {
my $self = shift;
if ($Verbose) { print "SerialPort::DESTROY called.\n"; }
$self->SUPER::DESTROY();
}
###############
sub alias {
my $self = shift;
if (@_) { $self->{ALIAS} = shift; } # should return true for legal names
return $self->{ALIAS};
}
sub user_msg {
my $self = shift;
if (@_) { $self->{U_MSG} = yes_true ( shift ) }
return wantarray ? @binary_opt : $self->{U_MSG};
}
sub error_msg {
my $self = shift;
if (@_) { $self->{E_MSG} = yes_true ( shift ) }
return wantarray ? @binary_opt : $self->{E_MSG};
}
sub devicetype {
my $self = shift;
if (@_) { $self->{DVTYPE} = shift; } # return true for legal names
return $self->{DVTYPE};
}
sub hostname {
my $self = shift;
if (@_) { $self->{HNAME} = shift; } # return true for legal names
return $self->{HNAME};
}
sub hostaddr {
my $self = shift;
if (@_) { $self->{HADDR} = shift; } # return true for assigned port
return $self->{HADDR};
}
sub datatype {
my $self = shift;
if (@_) { $self->{DATYPE} = shift; } # return true for legal types
return $self->{DATYPE};
}
sub cfg_param_1 {
my $self = shift;
if (@_) { $self->{CFG_1} = shift; } # return true for legal param
return $self->{CFG_1};
}
sub cfg_param_2 {
my $self = shift;
if (@_) { $self->{CFG_2} = shift; } # return true for legal param
return $self->{CFG_2};
}
sub cfg_param_3 {
my $self = shift;
if (@_) { $self->{CFG_3} = shift; } # return true for legal param
return $self->{CFG_3};
}
sub baudrate {
my $self = shift;
if (@_) {
unless ( defined $self->is_baudrate( shift ) ) {
if ($self->{U_MSG} or $Verbose) {
carp "Could not set baudrate on $self->{ALIAS}";
}
return;
}
}
return wantarray ? $self->are_baudrate : $self->is_baudrate;
}
sub status {
my $self = shift;
my $ok = 0;
my $fmask = 0;
my $v1 = $Verbose | $self->{"_DEBUG"};
my $v2 = $v1 | $self->{U_MSG};
my $v3 = $v1 | $self->{E_MSG};
my @stat = $self->is_status;
return unless (scalar @stat);
$fmask=$stat[ST_BLOCK];
if ($v1) { printf "BlockingFlags= %lx\n", $fmask; }
if ($v2 && $fmask) {
printf "Waiting for CTS\n" if ($fmask & BM_fCtsHold);
printf "Waiting for DSR\n" if ($fmask & BM_fDsrHold);
printf "Waiting for RLSD\n" if ($fmask & BM_fRlsdHold);
printf "Waiting for XON\n" if ($fmask & BM_fXoffHold);
printf "Waiting, XOFF was sent\n" if ($fmask & BM_fXoffSent);
printf "End_of_File received\n" if ($fmask & BM_fEof);
printf "Character waiting to TX\n" if ($fmask & BM_fTxim);
}
$fmask=$stat[ST_ERROR];
if ($v1) { printf "Error_BitMask= %lx\n", $fmask; }
if ($v3 && $fmask) {
# only prints if error is new (API resets each call)
printf "Invalid MODE or bad HANDLE\n" if ($fmask & CE_MODE);
printf "Receive Overrun detected\n" if ($fmask & CE_RXOVER);
printf "Buffer Overrun detected\n" if ($fmask & CE_OVERRUN);
printf "Parity Error detected\n" if ($fmask & CE_RXPARITY);
printf "Framing Error detected\n" if ($fmask & CE_FRAME);
printf "Break Signal detected\n" if ($fmask & CE_BREAK);
printf "Transmit Buffer is full\n" if ($fmask & CE_TXFULL);
}
return @stat;
}
sub handshake {
my $self = shift;
if (@_) {
unless ( $self->is_handshake(shift) ) {
if ($self->{U_MSG} or $Verbose) {
carp "Could not set handshake on $self->{ALIAS}";
}
return;
}
}
return wantarray ? $self->are_handshake : $self->is_handshake;
}
sub parity {
my $self = shift;
if (@_) {
unless ( $self->is_parity(shift) ) {
if ($self->{U_MSG} or $Verbose) {
carp "Could not set parity on $self->{ALIAS}";
}
return;
}
}
return wantarray ? $self->are_parity : $self->is_parity;
}
sub databits {
my $self = shift;
if (@_) {
unless ( $self->is_databits(shift) ) {
if ($self->{U_MSG} or $Verbose) {
carp "Could not set databits on $self->{ALIAS}";
}
return;
}
}
return wantarray ? $self->are_databits : $self->is_databits;
}
sub stopbits {
my $self = shift;
if (@_) {
unless ( $self->is_stopbits(shift) ) {
if ($self->{U_MSG} or $Verbose) {
carp "Could not set stopbits on $self->{ALIAS}";
}
return;
}
}
return wantarray ? $self->are_stopbits : $self->is_stopbits;
}
# single value for save/start
sub set_read_buf {
my $self = shift;
if (@_) {
return unless (@_ == 1);
my $rbuf = int shift;
return unless (($rbuf > 0) and ($rbuf <= $self->{MAX_RXB}));
$self->is_read_buf($rbuf);
}
return $self->is_read_buf;
}
# single value for save/start
sub set_write_buf {
my $self = shift;
if (@_) {
return unless (@_ == 1);
my $wbuf = int shift;
return unless (($wbuf >= 0) and ($wbuf <= $self->{MAX_TXB}));
$self->is_write_buf($wbuf);
}
return $self->is_write_buf;
}
sub buffers {
my $self = shift;
if (@_ == 2) {
my $rbuf = shift;
my $wbuf = shift;
unless (defined set_read_buf ($self, $rbuf)) {
if ($self->{U_MSG} or $Verbose) {
carp "Can't set read buffer on $self->{ALIAS}";
}
return;
}
unless (defined set_write_buf ($self, $wbuf)) {
if ($self->{U_MSG} or $Verbose) {
carp "Can't set write buffer on $self->{ALIAS}";
}
return;
}
$self->is_buffers($rbuf, $wbuf) || return;
}
elsif (@_) { return; }
return wantarray ? $self->are_buffers : 1;
}
sub read {
return unless (@_ == 2);
my $self = shift;
my $wanted = shift;
my $ok = 0;
my $result = "";
return unless ($wanted > 0);
my $got = $self->read_bg ($wanted);
if ($got != $wanted) {
($ok, $got, $result) = $self->read_done(1); # block until done
}
else { ($ok, $got, $result) = $self->read_done(0); }
print "read=$got\n" if ($Verbose);
return ($got, $result);
}
sub lookclear {
my $self = shift;
if (nocarp && (@_ == 1)) {
$self->{"_T_INPUT"} = shift;
}
$self->{"_LOOK"} = "";
$self->{"_LASTLOOK"} = "";
$self->{"_LMATCH"} = "";
$self->{"_LPATT"} = "";
return if (@_);
1;
}
sub linesize {
my $self = shift;
if (@_) {
my $val = int shift;
return if ($val < 0);
$self->{"_SIZE"} = $val;
}
return $self->{"_SIZE"};
}
sub lastline {
my $self = shift;
if (@_) {
$self->{"_LASTLINE"} = shift;
if ($] >= 5.005) {
eval '$self->{"_CLASTLINE"} = qr/$self->{"_LASTLINE"}/';
} else {
$self->{"_CLASTLINE"} = $self->{"_LASTLINE"};
}
}
return $self->{"_LASTLINE"};
}
sub matchclear {
my $self = shift;
my $found = $self->{"_LMATCH"};
$self->{"_LMATCH"} = "";
return if (@_);
return $found;
}
sub lastlook {
my $self = shift;
return if (@_);
return ( $self->{"_LMATCH"}, $self->{"_LASTLOOK"},
$self->{"_LPATT"}, $self->{"_LOOK"} );
}
sub lookfor {
my $self = shift;
my $size = 0;
if (@_) { $size = shift; }
my $loc = "";
my $count_in = 0;
my $string_in = "";
$self->{"_LMATCH"} = "";
$self->{"_LPATT"} = "";
if ( ! $self->{"_LOOK"} ) {
$loc = $self->{"_LASTLOOK"};
}
if ($size) {
my ($bbb, $iii, $ooo, $eee) = status($self);
if ($iii > $size) { $size = $iii; }
($count_in, $string_in) = $self->read($size);
return unless ($count_in);
$loc .= $string_in;
}
else {
$loc .= $self->input;
}
if ($loc ne "") {
if ($self->{icrnl}) { $loc =~ tr/\r/\n/; }
my $n_char;
my $mpos;
my $erase_is_bsdel = 0;
my $nl_after_kill = "";
my $clear_after_kill = 0;
my $echo_ctl = 0;
my $lookbuf;
my $re_next = 0;
my $got_match = 0;
my $pat;
my $lf_erase = "";
my $lf_kill = "";
my $lf_eof = "";
my $lf_quit = "";
my $lf_intr = "";
my $nl_2_crnl = 0;
my $cr_2_nl = 0;
if ($self->{opost}) {
$nl_2_crnl = $self->{onlcr};
$cr_2_nl = $self->{ocrnl};
}
if ($self->{echo}) {
$erase_is_bsdel = $self->{echoe};
if ($self->{echok}) {
$nl_after_kill = $self->{onlcr} ? "\r\n" : "\n";
}
$clear_after_kill = $self->{echoke};
$echo_ctl = $self->{echoctl};
}
if ($self->{icanon}) {
$lf_erase = $self->{erase};
$lf_kill = $self->{s_kill};
$lf_eof = $self->{s_eof};
}
if ($self->{isig}) {
$lf_quit = $self->{quit};
$lf_intr = $self->{intr};
}
my @loc_char = split (//, $loc);
while (defined ($n_char = shift @loc_char)) {
## printf STDERR "0x%x ", ord($n_char);
if ($n_char eq $lf_erase) {
if ($erase_is_bsdel && (length $self->{"_LOOK"}) ) {
$mpos = chop $self->{"_LOOK"};
$self->write($self->{bsdel});
if ($echo_ctl && (($mpos lt "@")|($mpos eq chr(127)))) {
$self->write($self->{bsdel});
}
}
}
elsif ($n_char eq $lf_kill) {
$self->{"_LOOK"} = "";
$self->write($self->{clear}) if ($clear_after_kill);
$self->write($nl_after_kill);
$self->write($self->{"_PROMPT"});
}
elsif ($n_char eq $lf_intr) {
$self->{"_LOOK"} = "";
$self->{"_LASTLOOK"} = "";
return;
}
elsif ($n_char eq $lf_quit) {
exit;
}
else {
$mpos = ord $n_char;
if ($self->{istrip}) {
if ($mpos > 127) { $n_char = chr($mpos - 128); }
}
$self->{"_LOOK"} .= $n_char;
## print $n_char;
if ($cr_2_nl) { $n_char =~ s/\r/\n/os; }
if ($nl_2_crnl) { $n_char =~ s/\n/\r\n/os; }
if (($mpos < 32) && $echo_ctl &&
($mpos != is_stty_eol($self))) {
$n_char = chr($mpos + 64);
$self->write("^$n_char");
}
elsif (($mpos == 127) && $echo_ctl) {
$self->write("^.");
}
elsif ($self->{echonl} && ($n_char =~ "\n")) {
# also writes "\r\n" for onlcr
$self->write($n_char);
}
elsif ($self->{echo}) {
# also writes "\r\n" for onlcr
$self->write($n_char);
}
$lookbuf = $self->{"_LOOK"};
if (($lf_eof ne "") and ($lookbuf =~ /$lf_eof$/)) {
$self->{"_LOOK"} = "";
$self->{"_LASTLOOK"} = "";
return $lookbuf;
}
$count_in = 0;
foreach $pat ( @{ $self->{"_CMATCH"} } ) {
if ($pat eq "-re") {
$re_next++;
$count_in++;
next;
}
if ($re_next) {
$re_next = 0;
# always at $lookbuf end when processing single char
if ( $lookbuf =~ s/$pat//s ) {
$self->{"_LMATCH"} = $&;
$got_match++;
}
}
elsif (($mpos = index($lookbuf, $pat)) > -1) {
$got_match++;
$lookbuf = substr ($lookbuf, 0, $mpos);
$self->{"_LMATCH"} = $pat;
}
if ($got_match) {
$self->{"_LPATT"} = $self->{"_MATCH"}[$count_in];
if (scalar @loc_char) {
$self->{"_LASTLOOK"} = join("", @loc_char);
## print ".$self->{\"_LASTLOOK\"}.";
}
else {
$self->{"_LASTLOOK"} = "";
}
$self->{"_LOOK"} = "";
return $lookbuf;
}
$count_in++;
}
}
}
}
return "";
}
sub streamline {
my $self = shift;
my $size = 0;
if (@_) { $size = shift; }
my $loc = "";
my $mpos;
my $count_in = 0;
my $string_in = "";
my $re_next = 0;
my $got_match = 0;
my $best_pos = 0;
my $pat;
my $match = "";
my $before = "";
my $after = "";
my $best_match = "";
my $best_before = "";
my $best_after = "";
my $best_pat = "";
$self->{"_LMATCH"} = "";
$self->{"_LPATT"} = "";
if ( ! $self->{"_LOOK"} ) {
$loc = $self->{"_LASTLOOK"};
}
if ($size) {
my ($bbb, $iii, $ooo, $eee) = status($self);
if ($iii > $size) { $size = $iii; }
($count_in, $string_in) = $self->read($size);
return unless ($count_in);
$loc .= $string_in;
}
else {
$loc .= $self->input;
}
if ($loc ne "") {
$self->{"_LOOK"} .= $loc;
$count_in = 0;
foreach $pat ( @{ $self->{"_CMATCH"} } ) {
if ($pat eq "-re") {
$re_next++;
$count_in++;
next;
}
if ($re_next) {
$re_next = 0;
if ( $self->{"_LOOK"} =~ /$pat/s ) {
( $match, $before, $after ) = ( $&, $`, $' );
$got_match++;
$mpos = length($before);
if ($mpos) {
next if ($best_pos && ($mpos > $best_pos));
$best_pos = $mpos;
$best_pat = $self->{"_MATCH"}[$count_in];
$best_match = $match;
$best_before = $before;
$best_after = $after;
} else {
$self->{"_LPATT"} = $self->{"_MATCH"}[$count_in];
$self->{"_LMATCH"} = $match;
$self->{"_LASTLOOK"} = $after;
$self->{"_LOOK"} = "";
return $before;
# pattern at start will be best
}
}
}
elsif (($mpos = index($self->{"_LOOK"}, $pat)) > -1) {
$got_match++;
$before = substr ($self->{"_LOOK"}, 0, $mpos);
if ($mpos) {
next if ($best_pos && ($mpos > $best_pos));
$best_pos = $mpos;
$best_pat = $pat;
$best_match = $pat;
$best_before = $before;
$mpos += length($pat);
$best_after = substr ($self->{"_LOOK"}, $mpos);
} else {
$self->{"_LPATT"} = $pat;
$self->{"_LMATCH"} = $pat;
$before = substr ($self->{"_LOOK"}, 0, $mpos);
$mpos += length($pat);
$self->{"_LASTLOOK"} = substr ($self->{"_LOOK"}, $mpos);
$self->{"_LOOK"} = "";
return $before;
# match at start will be best
}
}
$count_in++;
}
if ($got_match) {
$self->{"_LPATT"} = $best_pat;
$self->{"_LMATCH"} = $best_match;
$self->{"_LASTLOOK"} = $best_after;
$self->{"_LOOK"} = "";
return $best_before;
}
}
return "";
}
sub input {
return unless (@_ == 1);
my $self = shift;
my $result = "";
if (nocarp && $self->{"_T_INPUT"}) {
$result = $self->{"_T_INPUT"};
$self->{"_T_INPUT"} = "";
return $result;
}
my $ok = 0;
my $got_p = " "x4;
my ($bbb, $wanted, $ooo, $eee) = status($self);
return "" if ($eee);
return "" unless $wanted;
my $got = $self->read_bg ($wanted);
if ($got != $wanted) {
# block if unexpected happens
($ok, $got, $result) = $self->read_done(1); # block until done
}
else { ($ok, $got, $result) = $self->read_done(0); }
### print "input: got= $got result=$result\n";
return $got ? $result : "";
}
sub write {
return unless (@_ == 2);
my $self = shift;
my $wbuf = shift;
my $ok = 1;
return 0 if ($wbuf eq "");
my $lbuf = length ($wbuf);
my $written = $self->write_bg ($wbuf);
if ($written != $lbuf) {
($ok, $written) = $self->write_done(1); # block until done
}
if ($Verbose) {
print "wbuf=$wbuf\n";
print "lbuf=$lbuf\n";
print "written=$written\n";
}
return unless ($ok);
return $written;
}
sub transmit_char {
my $self = shift;
return unless (@_ == 1);
my $v = int shift;
return if (($v < 0) or ($v > 255));
return unless $self->xmit_imm_char ($v);
return wantarray ? @byte_opt : 1;
}
sub xon_char {
my $self = shift;
if (@_ == 1) {
my $v = int shift;
return if (($v < 0) or ($v > 255));
$self->is_xon_char($v);
}
return wantarray ? @byte_opt : $self->is_xon_char;
}
sub xoff_char {
my $self = shift;
if (@_ == 1) {
my $v = int shift;
return if (($v < 0) or ($v > 255));
$self->is_xoff_char($v);
}
return wantarray ? @byte_opt : $self->is_xoff_char;
}
sub eof_char {
my $self = shift;
if (@_ == 1) {
my $v = int shift;
return if (($v < 0) or ($v > 255));
$self->is_eof_char($v);
}
return wantarray ? @byte_opt : $self->is_eof_char;
}
sub event_char {
my $self = shift;
if (@_ == 1) {
my $v = int shift;
return if (($v < 0) or ($v > 255));
$self->is_event_char($v);
}
return wantarray ? @byte_opt : $self->is_event_char;
}
sub error_char {
my $self = shift;
if (@_ == 1) {
my $v = int shift;
return if (($v < 0) or ($v > 255));
$self->is_error_char($v);
}
return wantarray ? @byte_opt : $self->is_error_char;
}
sub xon_limit {
my $self = shift;
if (@_ == 1) {
my $v = int shift;
return if (($v < 0) or ($v > SHORTsize));
$self->is_xon_limit($v);
}
return wantarray ? (0, SHORTsize) : $self->is_xon_limit;
}
sub xoff_limit {
my $self = shift;
if (@_ == 1) {
my $v = int shift;
return if (($v < 0) or ($v > SHORTsize));
$self->is_xoff_limit($v);
}
return wantarray ? (0, SHORTsize) : $self->is_xoff_limit;
}
sub read_interval {
my $self = shift;
if (@_) {
return unless defined $self->is_read_interval( shift );
}
return wantarray ? (0, LONGsize) : $self->is_read_interval;
}
sub read_char_time {
my $self = shift;
if (@_) {
return unless defined $self->is_read_char_time( shift );
}
return wantarray ? (0, LONGsize) : $self->is_read_char_time;
}
sub read_const_time {
my $self = shift;
if (@_) {
return unless defined $self->is_read_const_time( shift );
}
return wantarray ? (0, LONGsize) : $self->is_read_const_time;
}
sub write_const_time {
my $self = shift;
if (@_) {
return unless defined $self->is_write_const_time( shift );
}
return wantarray ? (0, LONGsize) : $self->is_write_const_time;
}
sub write_char_time {
my $self = shift;
if (@_) {
return unless defined $self->is_write_char_time( shift );
}
return wantarray ? (0, LONGsize) : $self->is_write_char_time;
}
# true/false parameters
sub binary {
my $self = shift;
if (@_) {
return unless defined $self->is_binary( shift );
}
return $self->is_binary;
}
sub parity_enable {
my $self = shift;
if (@_) {
if ( $self->can_parity_enable ) {
$self->is_parity_enable( shift );
}
elsif ($self->{U_MSG}) {
carp "Can't set parity enable on $self->{ALIAS}";
}
}
return $self->is_parity_enable;
}
sub modemlines {
return unless (@_ == 1);
my $self = shift;
my $result = $self->is_modemlines;
if ($Verbose) {
print "CTS is ON\n" if ($result & MS_CTS_ON);
print "DSR is ON\n" if ($result & MS_DSR_ON);
print "RING is ON\n" if ($result & MS_RING_ON);
print "RLSD is ON\n" if ($result & MS_RLSD_ON);
}
return $result;
}
sub stty {
my $ob = shift;
my $token;
if (@_) {
my $ok = 1;
no strict 'refs'; # for $gosub
while ($token = shift) {
if (exists $opts{$token}) {
## print " $opts{$token}\n";
my ($gosub, $value) = split (':', $opts{$token});
if ($value eq "argv_char") { $value = &argv_char(shift); }
if (defined $value) {
&$gosub($ob, $value);
} else {
nocarp or carp "bad value for parameter $token\n";
$ok = 0;
}
}
else {
nocarp or carp "parameter $token not found\n";
$ok = 0;
}
}
use strict 'refs';
return $ok;
}
else {
my @settings; # array returned by ()
my $current = $ob->baudrate;
push @settings, "$current";
push @settings, "intr";
push @settings, cntl_char($ob->stty_intr);
push @settings, "quit";
push @settings, cntl_char($ob->stty_quit);
push @settings, "erase";
push @settings, cntl_char($ob->stty_erase);
push @settings, "kill";
push @settings, cntl_char($ob->stty_kill);
push @settings, "eof";
push @settings, cntl_char($ob->stty_eof);
push @settings, "eol";
push @settings, cntl_char($ob->stty_eol);
push @settings, "start";
push @settings, cntl_char(chr $ob->xon_char);
push @settings, "stop";
push @settings, cntl_char(chr $ob->xoff_char);
# "stop" is last CHAR type
push @settings, ($ob->stty_echo ? "" : "-")."echo";
push @settings, ($ob->stty_echoe ? "" : "-")."echoe";
push @settings, ($ob->stty_echok ? "" : "-")."echok";
push @settings, ($ob->stty_echonl ? "" : "-")."echonl";
push @settings, ($ob->stty_echoke ? "" : "-")."echoke";
push @settings, ($ob->stty_echoctl ? "" : "-")."echoctl";
push @settings, ($ob->stty_istrip ? "" : "-")."istrip";
push @settings, ($ob->stty_icrnl ? "" : "-")."icrnl";
push @settings, ($ob->stty_ocrnl ? "" : "-")."ocrnl";
push @settings, ($ob->stty_igncr ? "" : "-")."igncr";
push @settings, ($ob->stty_inlcr ? "" : "-")."inlcr";
push @settings, ($ob->stty_onlcr ? "" : "-")."onlcr";
push @settings, ($ob->stty_opost ? "" : "-")."opost";
push @settings, ($ob->stty_isig ? "" : "-")."isig";
push @settings, ($ob->stty_icanon ? "" : "-")."icanon";
$current = $ob->databits;
push @settings, "cs$current";
push @settings, (($ob->stopbits == 2) ? "" : "-")."cstopb";
$current = $ob->handshake;
push @settings, (($current eq "dtr") ? "" : "-")."clocal";
push @settings, (($current eq "rts") ? "" : "-")."crtscts";
push @settings, (($current eq "xoff") ? "" : "-")."ixoff";
push @settings, (($current eq "xoff") ? "" : "-")."ixon";
my $parity = $ob->parity;
if ($parity eq "none") {
push @settings, "-parenb";
push @settings, "-parodd";
push @settings, "-inpck";
}
else {
$current = $ob->is_parity_enable;
push @settings, ($current ? "" : "-")."parenb";
push @settings, (($parity eq "odd") ? "" : "-")."parodd";
push @settings, ($current ? "" : "-")."inpck";
# mark and space not supported
}
return @settings;
}
}
sub cntl_char {
my $n_char = shift;
return "<undef>" unless (defined $n_char);
my $pos = ord $n_char;
if ($pos < 32) {
$n_char = "^".chr($pos + 64);
}
if ($pos > 126) {
$n_char = sprintf "0x%x", $pos;
}
return $n_char;
}
sub argv_char {
my $n_char = shift;
return unless (defined $n_char);
my $pos = $n_char;
if ($n_char =~ s/^\^//) {
$pos = ord($n_char) - 64;
}
elsif ($n_char =~ s/^0x//) {
$pos = hex($n_char);
}
elsif ($n_char =~ /^0/) {
$pos = oct($n_char);
}
## print "pos = $pos\n";
return $pos;
}
sub debug {
my $self = shift;
if (ref($self)) {
if (@_) { $self->{"_DEBUG"} = yes_true ( shift ); }
else {
my $tmp = $self->{"_DEBUG"};
nocarp || carp "Debug level: $self->{ALIAS} = $tmp";
$self->debug_comm($tmp);
return $self->{"_DEBUG"};
}
} else {
$Verbose = yes_true ($self);
nocarp || carp "SerialPort Debug Class = $Verbose";
Win32API::CommPort::debug_comm($Verbose);
return $Verbose;
}
}
sub close {
my $self = shift;
return unless (defined $self->{ALIAS});
if ($Verbose or $self->{"_DEBUG"}) {
carp "Closing $self " . $self->{ALIAS};
}
my $success = $self->SUPER::close;
$self->{DEVICE} = undef;
$self->{ALIAS} = undef;
if ($Verbose) {
printf "SerialPort close result:%d\n", $success;
}
return $success;
}
1; # so the require or use succeeds
# Autoload methods go after =cut, and are processed by the autosplit program.
__END__
=pod
=head1 NAME
Win32::SerialPort - User interface to Win32 Serial API calls
=head1 SYNOPSIS
require 5.003;
use Win32::SerialPort qw( :STAT 0.19 );
=head2 Constructors
$PortObj = new Win32::SerialPort ($PortName, $quiet)
|| die "Can't open $PortName: $^E\n"; # $quiet is optional
$PortObj = start Win32::SerialPort ($Configuration_File_Name)
|| die "Can't start $Configuration_File_Name: $^E\n";
$PortObj = tie (*FH, 'Win32::SerialPort', $Configuration_File_Name)
|| die "Can't tie using $Configuration_File_Name: $^E\n";
=head2 Configuration Utility Methods
$PortObj->alias("MODEM1");
# before using start, restart, or tie
$PortObj->save($Configuration_File_Name)
|| warn "Can't save $Configuration_File_Name: $^E\n";
# after new, must check for failure
$PortObj->write_settings || undef $PortObj;
print "Can't change Device_Control_Block: $^E\n" unless ($PortObj);
# rereads file to either return open port to a known state
# or switch to a different configuration on the same port
$PortObj->restart($Configuration_File_Name)
|| warn "Can't reread $Configuration_File_Name: $^E\n";
# "app. variables" saved in $Configuration_File, not used internally
$PortObj->devicetype('none'); # CM11, CM17, 'weeder', 'modem'
$PortObj->hostname('localhost'); # for socket-based implementations
$PortObj->hostaddr(0); # false unless specified
$PortObj->datatype('raw'); # in case an application needs_to_know
$PortObj->cfg_param_1('none'); # null string '' hard to save/restore
$PortObj->cfg_param_2('none'); # 3 spares should be enough for now
$PortObj->cfg_param_3('none'); # one may end up as a log file path
# specials for test suite only
@necessary_param = Win32::SerialPort->set_test_mode_active(1);
$PortObj->lookclear("loopback to next 'input' method");
=head2 Configuration Parameter Methods
# most methods can be called three ways:
$PortObj->handshake("xoff"); # set parameter
$flowcontrol = $PortObj->handshake; # current value (scalar)
@handshake_opts = $PortObj->handshake; # permitted choices (list)
# similar
$PortObj->baudrate(9600);
$PortObj->parity("odd");
$PortObj->databits(8);
$PortObj->stopbits(1);
# range parameters return (minimum, maximum) in list context
$PortObj->xon_limit(100); # bytes left in buffer
$PortObj->xoff_limit(100); # space left in buffer
$PortObj->xon_char(0x11);
$PortObj->xoff_char(0x13);
$PortObj->eof_char(0x0);
$PortObj->event_char(0x0);
$PortObj->error_char(0); # for parity errors
$PortObj->buffers(4096, 4096); # read, write
# returns current in list context
$PortObj->read_interval(100); # max time between read char (milliseconds)
$PortObj->read_char_time(5); # avg time between read char
$PortObj->read_const_time(100); # total = (avg * bytes) + const
$PortObj->write_char_time(5);
$PortObj->write_const_time(100);
# true/false parameters (return scalar context only)
$PortObj->binary(T); # just say Yes (Win 3.x option)
$PortObj->parity_enable(F); # faults during input
$PortObj->debug(0);
=head2 Operating Methods
($BlockingFlags, $InBytes, $OutBytes, $LatchErrorFlags) = $PortObj->status
|| warn "could not get port status\n";
if ($BlockingFlags) { warn "Port is blocked"; }
if ($BlockingFlags & BM_fCtsHold) { warn "Waiting for CTS"; }
if ($LatchErrorFlags & CE_FRAME) { warn "Framing Error"; }
# The API resets errors when reading status, $LatchErrorFlags
# is all $ErrorFlags seen since the last reset_error
Additional useful constants may be exported eventually. If the only fault
action desired is a message, B<status> provides I<Built-In> BitMask processing:
$PortObj->error_msg(1); # prints hardware messages like "Framing Error"
$PortObj->user_msg(1); # prints function messages like "Waiting for CTS"
($count_in, $string_in) = $PortObj->read($InBytes);
warn "read unsuccessful\n" unless ($count_in == $InBytes);
$count_out = $PortObj->write($output_string);
warn "write failed\n" unless ($count_out);
warn "write incomplete\n" if ( $count_out != length($output_string) );
if ($string_in = $PortObj->input) { PortObj->write($string_in); }
# simple echo with no control character processing
$PortObj->transmit_char(0x03); # bypass buffer (and suspend)
$ModemStatus = $PortObj->modemlines;
if ($ModemStatus & $PortObj->MS_RLSD_ON) { print "carrier detected"; }
=head2 Methods used with Tied FileHandles
$PortObj = tie (*FH, 'Win32::SerialPort', $Configuration_File_Name)
|| die "Can't tie: $^E\n"; ## TIEHANDLE ##
print FH "text"; ## PRINT ##
$char = getc FH; ## GETC ##
syswrite FH, $out, length($out), 0; ## WRITE ##
$line = <FH>; ## READLINE ##
@lines = <FH>; ## READLINE ##
printf FH "received: %s", $line; ## PRINTF ##
read (FH, $in, 5, 0) or die "$^E"; ## READ ##
sysread (FH, $in, 5, 0) or die "$^E"; ## READ ##
close FH || warn "close failed"; ## CLOSE ##
undef $PortObj;
untie *FH; ## DESTROY ##
$PortObj->linesize(10); # with READLINE
$PortObj->lastline("_GOT_ME_"); # with READLINE, list only
$old_ors = $PortObj->output_record_separator("RECORD"); # with PRINT
$old_ofs = $PortObj->output_field_separator("COMMA"); # with PRINT
=head2 Destructors
$PortObj->close || warn "close failed";
# passed to CommPort to release port to OS - needed to reopen
# close will not usually DESTROY the object
# also called as: close FH || warn "close failed";
undef $PortObj;
# preferred unless reopen expected since it triggers DESTROY
# calls $PortObj->close but does not confirm success
# MUST precede untie - do all three IN THIS SEQUENCE before re-tie.
untie *FH;
=head2 Methods for I/O Processing
$PortObj->are_match("text", "\n"); # possible end strings
$PortObj->lookclear; # empty buffers
$PortObj->write("Feed Me:"); # initial prompt
$PortObj->is_prompt("More Food:"); # new prompt after "kill" char
my $gotit = "";
my $match1 = "";
until ("" ne $gotit) {
$gotit = $PortObj->lookfor; # poll until data ready
die "Aborted without match\n" unless (defined $gotit);
last if ($gotit);
$match1 = $PortObj->matchclear; # match is first thing received
last if ($match1);
sleep 1; # polling sample time
}
printf "gotit = %s\n", $gotit; # input BEFORE the match
my ($match, $after, $pattern, $instead) = $PortObj->lastlook;
# input that MATCHED, input AFTER the match, PATTERN that matched
# input received INSTEAD when timeout without match
if ($match1) {
$match = $match1;
}
printf "lastlook-match = %s -after = %s -pattern = %s\n",
$match, $after, $pattern;
$gotit = $PortObj->lookfor($count); # block until $count chars received
$PortObj->are_match("-re", "pattern", "text");
# possible match strings: "pattern" is a regular expression,
# "text" is a literal string
$gotit = $PortObj->streamline; # poll until data ready
$gotit = $PortObj->streamline($count);# block until $count chars received
# fast alternatives to lookfor with no character processing
$PortObj->stty_intr("\cC"); # char to abort lookfor method
$PortObj->stty_quit("\cD"); # char to abort perl
$PortObj->stty_eof("\cZ"); # end_of_file char
$PortObj->stty_eol("\cJ"); # end_of_line char
$PortObj->stty_erase("\cH"); # delete one character from buffer (backspace)
$PortObj->stty_kill("\cU"); # clear line buffer
$PortObj->is_stty_intr(3); # ord(char) to abort lookfor method
$qc = $PortObj->is_stty_quit; # ($qc == 4) for "\cD"
$PortObj->is_stty_eof(26);
$PortObj->is_s