mirror of
https://github.com/valmojr/armatak.git
synced 2026-08-18 16:02:58 +00:00
Compare commits
74 Commits
v1.3.0
...
feature/ci
| Author | SHA1 | Date | |
|---|---|---|---|
| ccc63d1a35 | |||
| aa2a088892 | |||
| 9f560b546a | |||
| 806e317a55 | |||
| bcb2d1983b | |||
| e71fd38b46 | |||
| 8278dab9a3 | |||
| 66a20e7527 | |||
| fe8a134897 | |||
| 7bb2da2412 | |||
| fe6bad6e88 | |||
| 7374b7222d | |||
| 2c6ca81669 | |||
| d799e99cb8 | |||
| e71db4e514 | |||
| 15e45fff71 | |||
| 3724a85c9f | |||
| 81a5a34cf2 | |||
| 26a18eac6d | |||
| 7a6c4d5bfc | |||
| ff218d6d00 | |||
| d70eb15924 | |||
| ec3507910d | |||
| c941e61e20 | |||
| 398f11efb8 | |||
| 95bb4e75e1 | |||
| a213fd916c | |||
| 74620d3346 | |||
| 5e3e3cb7a0 | |||
| 4432ea20f1 | |||
| 395487f26e | |||
| 6dee1987bb | |||
| d35ccd58e1 | |||
| 980107e00b | |||
| e53ba2ae0f | |||
| 37aa51f8c2 | |||
| ad03444ff5 | |||
| 167d47e488 | |||
| 3a82dba854 | |||
| 1fff02cdd2 | |||
| 1ab318c279 | |||
| 7a1a4b7372 | |||
| 2802f9cdc8 | |||
| ed039035df | |||
| 7fa4a7c411 | |||
| d4dfd80cdf | |||
| 720f9da2df | |||
| 5015f09d1d | |||
| 882a35c2cd | |||
| 6b3ce96c18 | |||
| 760027b925 | |||
| 9b05bcccc2 | |||
| 80320c0f2c | |||
| b43a6c9748 | |||
| dcc9e1d469 | |||
| 3c37185c1a | |||
| 671e7d5dc1 | |||
| 0ebd192487 | |||
| 3fc54a1fb5 | |||
| eaf38a4d06 | |||
| 6376b7acf0 | |||
| 52edf94b17 | |||
| 3e11dd9e16 | |||
| a9f09b6ce6 | |||
| a43aa60f45 | |||
| 9cba642e9b | |||
| c7494da901 | |||
| b9e848d66e | |||
| 99f8d991be | |||
| 753dcab26e | |||
| 2f53488ba8 | |||
| 323339e679 | |||
| 3f14a75e81 | |||
| 469a54c141 |
@@ -0,0 +1,58 @@
|
|||||||
|
name: Rust CI
|
||||||
|
|
||||||
|
on:
|
||||||
|
push:
|
||||||
|
branches:
|
||||||
|
- main
|
||||||
|
- "feature/**"
|
||||||
|
pull_request:
|
||||||
|
branches:
|
||||||
|
- main
|
||||||
|
|
||||||
|
permissions:
|
||||||
|
contents: read
|
||||||
|
|
||||||
|
concurrency:
|
||||||
|
group: rust-ci-${{ github.workflow }}-${{ github.ref }}
|
||||||
|
cancel-in-progress: true
|
||||||
|
|
||||||
|
jobs:
|
||||||
|
test-and-coverage:
|
||||||
|
name: Rust tests and coverage
|
||||||
|
runs-on: ubuntu-latest
|
||||||
|
timeout-minutes: 30
|
||||||
|
|
||||||
|
steps:
|
||||||
|
- name: Check out repository
|
||||||
|
uses: actions/checkout@v4
|
||||||
|
|
||||||
|
- name: Install stable Rust
|
||||||
|
uses: dtolnay/rust-toolchain@stable
|
||||||
|
|
||||||
|
- name: Cache Rust build artifacts
|
||||||
|
uses: Swatinem/rust-cache@v2
|
||||||
|
|
||||||
|
- name: Install cargo-llvm-cov
|
||||||
|
uses: taiki-e/install-action@cargo-llvm-cov
|
||||||
|
|
||||||
|
- name: Run unit tests
|
||||||
|
run: cargo test --all-targets --locked
|
||||||
|
|
||||||
|
- name: Report whole-extension coverage
|
||||||
|
run: cargo llvm-cov --all-targets --locked --summary-only --show-missing-lines
|
||||||
|
|
||||||
|
- name: Enforce 100% coverage on deterministic core
|
||||||
|
run: |
|
||||||
|
cargo llvm-cov --all-targets --locked --summary-only \
|
||||||
|
--ignore-filename-regex 'src/(lib\.rs|tests\.rs|structs\.rs|mdns\.rs|udp_socket\.rs|video_stream\.rs|tcp/(client\.rs|cot\.rs|draw\.rs|mod\.rs|transport\.rs)|tcp/tls/(connector\.rs|enrollment\.rs|mod\.rs)|cot/(cot\.rs|delete\.rs|digital_pointer\.rs|draws/.*|eud\.rs|gps\.rs|lrf\.rs|message\.rs|mod\.rs|nato\.rs|report_marker\.rs|uas\.rs)|uas/(callbacks\.rs|constants\.rs|endpoint\.rs|identity\.rs|mod\.rs|packets\.rs|payload\.rs|send\.rs|state\.rs)|utils/(address\.rs|log\.rs|mod\.rs))' \
|
||||||
|
--fail-under-lines 100
|
||||||
|
|
||||||
|
- name: Generate LCOV artifact
|
||||||
|
run: cargo llvm-cov --all-targets --locked --lcov --output-path lcov.info
|
||||||
|
|
||||||
|
- name: Upload LCOV artifact
|
||||||
|
uses: actions/upload-artifact@v4
|
||||||
|
with:
|
||||||
|
name: rust-lcov
|
||||||
|
path: lcov.info
|
||||||
|
if-no-files-found: error
|
||||||
@@ -89,3 +89,6 @@ target/
|
|||||||
local.properties
|
local.properties
|
||||||
|
|
||||||
*.apk
|
*.apk
|
||||||
|
|
||||||
|
|
||||||
|
.hemtt/missions
|
||||||
+1
-22
@@ -38,28 +38,7 @@ preset = "Hemtt"
|
|||||||
[hemtt.launch.default]
|
[hemtt.launch.default]
|
||||||
workshop = [
|
workshop = [
|
||||||
"450814997", # CBA_A3
|
"450814997", # CBA_A3
|
||||||
"463939057", # ACE
|
"463939057", # ace
|
||||||
"751965892", # ACRE2
|
|
||||||
"2522638637", # ACE Extended Arsenal
|
|
||||||
"333310405", # Enhanced Movement
|
|
||||||
"2034363662", # Enhanced Movement Rework
|
|
||||||
"2941986336", # Hatchet Interaction Framework - Stable Version
|
|
||||||
"1745501605", # Hatchet H-60 pack - Stable Version
|
|
||||||
"843577117", # RHSUSAF
|
|
||||||
"843425103", # RHSAFRF
|
|
||||||
"843632231", # RHSSAF
|
|
||||||
"843593391", # RHSGREF
|
|
||||||
"1673456286", # 3CB Factions
|
|
||||||
"623475643", # 3den Enhanced
|
|
||||||
"2257686620", # Blastcore Murr Edition
|
|
||||||
"583496184", # CUP Terrains - Core
|
|
||||||
"3078351739", # Kunduz River
|
|
||||||
"1858075458", # LAMBS_Danger.fsm
|
|
||||||
"1808238502", # LAMBS_Suppression
|
|
||||||
"3425368881", # M4A1_URGI
|
|
||||||
"2268351256", # Tier One Weapons
|
|
||||||
"2560276469", # Restrict Markers
|
|
||||||
"3493557838" # Ballad of the Green Berets
|
|
||||||
]
|
]
|
||||||
|
|
||||||
parameters = [
|
parameters = [
|
||||||
|
|||||||
@@ -4,10 +4,6 @@
|
|||||||
|
|
||||||
ARMATAK is a server side Arma 3 addons for streaming unit positions to TAK Clients in sessions on real locations maps. It can be runned both as a clientside mod or a serverside mod, when runned serverside, it will create a TCP Socket connection between Arma 3 and the TAK Server, sending the game session information into it. When used clientside, Arma 3 will host a websocket server that you can connect to your phone and mock the phone's location to the player's in game location.
|
ARMATAK is a server side Arma 3 addons for streaming unit positions to TAK Clients in sessions on real locations maps. It can be runned both as a clientside mod or a serverside mod, when runned serverside, it will create a TCP Socket connection between Arma 3 and the TAK Server, sending the game session information into it. When used clientside, Arma 3 will host a websocket server that you can connect to your phone and mock the phone's location to the player's in game location.
|
||||||
|
|
||||||
The server-side CoT router supports two transports:
|
|
||||||
- Plain TCP, for legacy TAK ingress.
|
|
||||||
- Mutual TLS, using the TAK Server authentication API, so the Arma session can publish as an authenticated TAK device on port `8089`.
|
|
||||||
|
|
||||||
## Get in Touch
|
## Get in Touch
|
||||||
|
|
||||||
[Join the Discord Server for ARMATAK!](https://discord.gg/svK64PCycU)
|
[Join the Discord Server for ARMATAK!](https://discord.gg/svK64PCycU)
|
||||||
|
|||||||
@@ -1,3 +1,5 @@
|
|||||||
PREP(convertClientLocation);
|
PREP(convertClientLocation);
|
||||||
PREP(extractClientPosition);
|
PREP(extractClientPosition);
|
||||||
|
PREP(initCuratorRouterIndicators);
|
||||||
|
PREP(sendLaserRangeFinder);
|
||||||
PREP(startUDPSocket);
|
PREP(startUDPSocket);
|
||||||
|
|||||||
@@ -6,3 +6,6 @@ _local_address = "armatak" callExtension ["local_ip", []] select 0;
|
|||||||
|
|
||||||
SETVAR(player,GVAR(localAddress),_local_address);
|
SETVAR(player,GVAR(localAddress),_local_address);
|
||||||
SETVAR(player,GVAR(eudConnected),false);
|
SETVAR(player,GVAR(eudConnected),false);
|
||||||
|
SETVAR(player,GVAR(lrfEnabled),false);
|
||||||
|
|
||||||
|
call FUNC(initCuratorRouterIndicators);
|
||||||
|
|||||||
+66
-13
@@ -10,44 +10,97 @@ class armatak_udp_socket_start_dialog {
|
|||||||
class armatak_gui_module_udp_socket_dialog_main_frame: RscBackground {
|
class armatak_gui_module_udp_socket_dialog_main_frame: RscBackground {
|
||||||
idc = 16960;
|
idc = 16960;
|
||||||
x = "0.386562 * safezoneW + safezoneX";
|
x = "0.386562 * safezoneW + safezoneX";
|
||||||
y = "0.401 * safezoneH + safezoneY";
|
y = "0.357 * safezoneH + safezoneY";
|
||||||
w = "0.216563 * safezoneW";
|
w = "0.216563 * safezoneW";
|
||||||
h = "0.242 * safezoneH";
|
h = "0.495 * safezoneH";
|
||||||
colorBackground[]={0,0,0,0.45};
|
colorBackground[]={0,0,0,0.45};
|
||||||
};
|
};
|
||||||
};
|
};
|
||||||
class Controls {
|
class Controls {
|
||||||
class armatak_gui_module_udp_socket_dialog_address_edit: RscEdit {
|
class armatak_gui_module_udp_socket_dialog_address_edit: RscEdit {
|
||||||
idc = 16961;
|
idc = 16961;
|
||||||
text = "168.15.0.3";
|
text = "192.168.15.121";
|
||||||
x = "0.391719 * safezoneW + safezoneX";
|
x = "0.391719 * safezoneW + safezoneX";
|
||||||
y = "0.445 * safezoneH + safezoneY";
|
y = "0.401 * safezoneH + safezoneY";
|
||||||
w = "0.20625 * safezoneW";
|
w = "0.20625 * safezoneW";
|
||||||
h = "0.044 * safezoneH";
|
h = "0.044 * safezoneH";
|
||||||
colorBackground[]={0,0,0,0.5};
|
colorBackground[]={0,0,0,0.5};
|
||||||
};
|
};
|
||||||
class armatak_gui_module_udp_socket_dialog_address_port_edit: RscEdit {
|
class armatak_gui_module_udp_socket_dialog_gnss_port_edit: RscEdit {
|
||||||
idc = 16962;
|
idc = 16962;
|
||||||
text = "4349";
|
text = "4349";
|
||||||
x = "0.391719 * safezoneW + safezoneX";
|
x = "0.391719 * safezoneW + safezoneX";
|
||||||
y = "0.522 * safezoneH + safezoneY";
|
y = "0.478 * safezoneH + safezoneY";
|
||||||
w = "0.20625 * safezoneW";
|
w = "0.20625 * safezoneW";
|
||||||
h = "0.044 * safezoneH";
|
h = "0.044 * safezoneH";
|
||||||
colorBackground[]={0,0,0,0.5};
|
colorBackground[]={0,0,0,0.5};
|
||||||
};
|
};
|
||||||
|
class armatak_gui_module_udp_socket_dialog_mavlink_port_edit: RscEdit {
|
||||||
|
idc = 16967;
|
||||||
|
text = "14550";
|
||||||
|
x = "0.391719 * safezoneW + safezoneX";
|
||||||
|
y = "0.555 * safezoneH + safezoneY";
|
||||||
|
w = "0.20625 * safezoneW";
|
||||||
|
h = "0.044 * safezoneH";
|
||||||
|
colorBackground[]={0,0,0,0.5};
|
||||||
|
};
|
||||||
|
class armatak_gui_module_udp_socket_dialog_video_feed_url_edit: RscEdit {
|
||||||
|
idc = 16969;
|
||||||
|
text = "";
|
||||||
|
x = "0.391719 * safezoneW + safezoneX";
|
||||||
|
y = "0.709 * safezoneH + safezoneY";
|
||||||
|
w = "0.20625 * safezoneW";
|
||||||
|
h = "0.044 * safezoneH";
|
||||||
|
colorBackground[]={0,0,0,0.5};
|
||||||
|
tooltip = "Optional shared feed URL. If empty, the UAV 3DEN URL is used first, then a local RTP fallback.";
|
||||||
|
};
|
||||||
|
class armatak_gui_module_udp_socket_dialog_lrf_port_edit: RscEdit {
|
||||||
|
idc = 16971;
|
||||||
|
text = "17211";
|
||||||
|
x = "0.391719 * safezoneW + safezoneX";
|
||||||
|
y = "0.632 * safezoneH + safezoneY";
|
||||||
|
w = "0.20625 * safezoneW";
|
||||||
|
h = "0.044 * safezoneH";
|
||||||
|
colorBackground[]={0,0,0,0.5};
|
||||||
|
tooltip = "ATAK local Laser Range Finder UDP input. Leave empty to disable.";
|
||||||
|
};
|
||||||
class armatak_gui_module_udp_socket_dialog_address_text: RscText {
|
class armatak_gui_module_udp_socket_dialog_address_text: RscText {
|
||||||
idc = 16963;
|
idc = 16963;
|
||||||
text = "Phone's Socket Local Address";
|
text = "EUD's Address";
|
||||||
x = "0.391719 * safezoneW + safezoneX";
|
x = "0.391719 * safezoneW + safezoneX";
|
||||||
y = "0.412 * safezoneH + safezoneY";
|
y = "0.368 * safezoneH + safezoneY";
|
||||||
w = "0.20625 * safezoneW";
|
w = "0.20625 * safezoneW";
|
||||||
h = "0.033 * safezoneH";
|
h = "0.033 * safezoneH";
|
||||||
};
|
};
|
||||||
class armatak_gui_module_udp_socket_dialog_address_port_text: RscText {
|
class armatak_gui_module_udp_socket_dialog_gnss_port_text: RscText {
|
||||||
idc = 16964;
|
idc = 16964;
|
||||||
text = "Phone's Socket Local Port";
|
text = "Network GNSS Port";
|
||||||
x = "0.391719 * safezoneW + safezoneX";
|
x = "0.391719 * safezoneW + safezoneX";
|
||||||
y = "0.489 * safezoneH + safezoneY";
|
y = "0.445 * safezoneH + safezoneY";
|
||||||
|
w = "0.20625 * safezoneW";
|
||||||
|
h = "0.033 * safezoneH";
|
||||||
|
};
|
||||||
|
class armatak_gui_module_udp_socket_dialog_mavlink_port_text: RscText {
|
||||||
|
idc = 16968;
|
||||||
|
text = "Mavlink Port";
|
||||||
|
x = "0.391719 * safezoneW + safezoneX";
|
||||||
|
y = "0.522 * safezoneH + safezoneY";
|
||||||
|
w = "0.20625 * safezoneW";
|
||||||
|
h = "0.033 * safezoneH";
|
||||||
|
};
|
||||||
|
class armatak_gui_module_udp_socket_dialog_video_feed_url_text: RscText {
|
||||||
|
idc = 16970;
|
||||||
|
text = "Video Feed URL (Optional)";
|
||||||
|
x = "0.391719 * safezoneW + safezoneX";
|
||||||
|
y = "0.676 * safezoneH + safezoneY";
|
||||||
|
w = "0.20625 * safezoneW";
|
||||||
|
h = "0.033 * safezoneH";
|
||||||
|
};
|
||||||
|
class armatak_gui_module_udp_socket_dialog_lrf_port_text: RscText {
|
||||||
|
idc = 16972;
|
||||||
|
text = "Laser Range Finder Port";
|
||||||
|
x = "0.391719 * safezoneW + safezoneX";
|
||||||
|
y = "0.599 * safezoneH + safezoneY";
|
||||||
w = "0.20625 * safezoneW";
|
w = "0.20625 * safezoneW";
|
||||||
h = "0.033 * safezoneH";
|
h = "0.033 * safezoneH";
|
||||||
};
|
};
|
||||||
@@ -56,7 +109,7 @@ class armatak_udp_socket_start_dialog {
|
|||||||
text = "Cancel";
|
text = "Cancel";
|
||||||
action = "closeDialog 2;";
|
action = "closeDialog 2;";
|
||||||
x = "0.551563 * safezoneW + safezoneX";
|
x = "0.551563 * safezoneW + safezoneX";
|
||||||
y = "0.577 * safezoneH + safezoneY";
|
y = "0.786 * safezoneH + safezoneY";
|
||||||
w = "0.0464063 * safezoneW";
|
w = "0.0464063 * safezoneW";
|
||||||
h = "0.055 * safezoneH";
|
h = "0.055 * safezoneH";
|
||||||
};
|
};
|
||||||
@@ -65,7 +118,7 @@ class armatak_udp_socket_start_dialog {
|
|||||||
text = "Ok";
|
text = "Ok";
|
||||||
action = QUOTE(call FUNC(startUDPSocket));
|
action = QUOTE(call FUNC(startUDPSocket));
|
||||||
x = "0.5 * safezoneW + safezoneX";
|
x = "0.5 * safezoneW + safezoneX";
|
||||||
y = "0.577 * safezoneH + safezoneY";
|
y = "0.786 * safezoneH + safezoneY";
|
||||||
w = "0.0464063 * safezoneW";
|
w = "0.0464063 * safezoneW";
|
||||||
h = "0.055 * safezoneH";
|
h = "0.055 * safezoneH";
|
||||||
};
|
};
|
||||||
|
|||||||
@@ -19,11 +19,15 @@
|
|||||||
* Public: Yes
|
* Public: Yes
|
||||||
*/
|
*/
|
||||||
|
|
||||||
params["_latitude", "_longitude", "_altitude"];
|
params [
|
||||||
|
["_latitude", 0, [0]],
|
||||||
|
["_longitude", 0, [0]],
|
||||||
|
["_altitude", 0, [0]]
|
||||||
|
];
|
||||||
|
|
||||||
_position = [_latitude, _longitude, _altitude];
|
private _position = [_latitude, _longitude, _altitude];
|
||||||
|
|
||||||
_realLocation = null;
|
private _realLocation = [0, 0, _altitude];
|
||||||
|
|
||||||
switch (toLower worldName) do {
|
switch (toLower worldName) do {
|
||||||
case "altis": {
|
case "altis": {
|
||||||
@@ -107,6 +111,12 @@ switch (toLower worldName) do {
|
|||||||
case "rut_mandol": {
|
case "rut_mandol": {
|
||||||
_realLocation = _position call armatak_fnc_convert_to_rut_mandol;
|
_realLocation = _position call armatak_fnc_convert_to_rut_mandol;
|
||||||
};
|
};
|
||||||
|
case "hellanmaa": {
|
||||||
|
_realLocation = _position call armatak_fnc_convert_to_hellanmaa;
|
||||||
|
};
|
||||||
|
case "hellanmaaw": {
|
||||||
|
_realLocation = _position call armatak_fnc_convert_to_hellanmaa;
|
||||||
|
};
|
||||||
default {
|
default {
|
||||||
_warning = format ["<t color='#FF8021'>ARMATAK</t><br/> %1", "Unsupported Map"];
|
_warning = format ["<t color='#FF8021'>ARMATAK</t><br/> %1", "Unsupported Map"];
|
||||||
[[_warning, 1.5]] call CBA_fnc_notify;
|
[[_warning, 1.5]] call CBA_fnc_notify;
|
||||||
|
|||||||
@@ -0,0 +1,49 @@
|
|||||||
|
#include "..\script_component.hpp"
|
||||||
|
/*
|
||||||
|
* Author: Codex
|
||||||
|
* Draws a Zeus-only visual border over entities routed by the ArmaTAK CoT Router.
|
||||||
|
*
|
||||||
|
* Arguments:
|
||||||
|
* None
|
||||||
|
*
|
||||||
|
* Return Value:
|
||||||
|
* Draw3D event handler id <NUMBER>
|
||||||
|
*
|
||||||
|
* Public: No
|
||||||
|
*/
|
||||||
|
|
||||||
|
if (!hasInterface) exitWith {-1};
|
||||||
|
|
||||||
|
private _existingEh = missionNamespace getVariable [QGVAR(curatorRouterIndicatorEh), -1];
|
||||||
|
if (_existingEh >= 0) exitWith {_existingEh};
|
||||||
|
|
||||||
|
private _eh = addMissionEventHandler ["Draw3D", {
|
||||||
|
if (isNull findDisplay 312) exitWith {};
|
||||||
|
|
||||||
|
private _curator = getAssignedCuratorLogic player;
|
||||||
|
if (isNull _curator) exitWith {};
|
||||||
|
|
||||||
|
private _routed = missionNamespace getVariable ["armatak_server_syncedUnits", []];
|
||||||
|
if (_routed isEqualTo []) exitWith {};
|
||||||
|
|
||||||
|
private _editableObjects = curatorEditableObjects _curator;
|
||||||
|
private _texture = "\a3\ui_f\data\IGUI\Cfg\Cursors\selected_ca.paa";
|
||||||
|
private _color = [0, 0.85, 1, 0.95];
|
||||||
|
private _camera = curatorCamera;
|
||||||
|
|
||||||
|
{
|
||||||
|
if (!isNull _x && {alive _x} && {_x in _editableObjects}) then {
|
||||||
|
private _pos = ASLToAGL (getPosASLVisual _x);
|
||||||
|
_pos set [2, (_pos select 2) + 0.12];
|
||||||
|
|
||||||
|
private _distance = _camera distance _x;
|
||||||
|
private _size = linearConversion [0, 2000, _distance, 0.8, 1.35, true];
|
||||||
|
private _textSize = linearConversion [0, 2000, _distance, 0.032, 0.05, true];
|
||||||
|
drawIcon3D [_texture, _color, _pos, _size, _size, 0, "TAK", 1, _textSize, "RobotoCondensed", "center"];
|
||||||
|
};
|
||||||
|
} forEach _routed;
|
||||||
|
}];
|
||||||
|
|
||||||
|
missionNamespace setVariable [QGVAR(curatorRouterIndicatorEh), _eh];
|
||||||
|
|
||||||
|
_eh
|
||||||
@@ -0,0 +1,52 @@
|
|||||||
|
#include "..\script_component.hpp"
|
||||||
|
|
||||||
|
params ["_unit"];
|
||||||
|
|
||||||
|
private _lrfEnabled = player getVariable [QGVAR(lrfEnabled), false];
|
||||||
|
|
||||||
|
private _uid = format ["%1.LRF", _unit call armatak_fnc_extract_uuid];
|
||||||
|
private _laserTarget = laserTarget _unit;
|
||||||
|
|
||||||
|
if (!isNull _laserTarget) exitWith {
|
||||||
|
private _originASL = getPosASL _unit;
|
||||||
|
private _targetASL = getPosASL _laserTarget;
|
||||||
|
private _delta = _targetASL vectorDiff _originASL;
|
||||||
|
|
||||||
|
private _dx = _delta select 0;
|
||||||
|
private _dy = _delta select 1;
|
||||||
|
private _dz = _delta select 2;
|
||||||
|
private _horizontalDistance = sqrt ((_dx * _dx) + (_dy * _dy));
|
||||||
|
private _slantDistance = (_originASL vectorDistance _targetASL) max 1;
|
||||||
|
private _azimuth = (((_dx atan2 _dy) + 360) mod 360);
|
||||||
|
private _elevation = _dz atan2 (_horizontalDistance max 0.001);
|
||||||
|
private _lastTargetASL = player getVariable [QGVAR(lrfLastTargetASL), []];
|
||||||
|
private _lastSentAt = player getVariable [QGVAR(lrfLastSentAt), -1000];
|
||||||
|
private _targetMoved = _lastTargetASL isEqualTo [] || {(_lastTargetASL vectorDistance _targetASL) > 5};
|
||||||
|
private _sendCooldownElapsed = (time - _lastSentAt) >= 2.5;
|
||||||
|
|
||||||
|
player setVariable [QGVAR(lrfWasActive), true];
|
||||||
|
player setVariable [QGVAR(lrfLostAt), -1];
|
||||||
|
player setVariable [QGVAR(lrfClearSent), false];
|
||||||
|
|
||||||
|
if (_lrfEnabled && {_targetMoved} && {_sendCooldownElapsed}) then {
|
||||||
|
"armatak" callExtension ["udp_socket:send_lrf", [[_uid, _slantDistance, _azimuth, _elevation]]];
|
||||||
|
player setVariable [QGVAR(lrfLastTargetASL), _targetASL];
|
||||||
|
player setVariable [QGVAR(lrfLastSentAt), time];
|
||||||
|
};
|
||||||
|
};
|
||||||
|
|
||||||
|
if !(player getVariable [QGVAR(lrfWasActive), false]) exitWith {};
|
||||||
|
|
||||||
|
private _lostAt = player getVariable [QGVAR(lrfLostAt), -1];
|
||||||
|
if (_lostAt < 0) then {
|
||||||
|
player setVariable [QGVAR(lrfLostAt), time];
|
||||||
|
};
|
||||||
|
|
||||||
|
private _clearSent = player getVariable [QGVAR(lrfClearSent), false];
|
||||||
|
if (_lrfEnabled && {!_clearSent} && {(time - (player getVariable [QGVAR(lrfLostAt), time])) >= 6}) then {
|
||||||
|
"armatak" callExtension ["udp_socket:clear_lrf", [_uid]];
|
||||||
|
player setVariable [QGVAR(lrfWasActive), false];
|
||||||
|
player setVariable [QGVAR(lrfClearSent), true];
|
||||||
|
player setVariable [QGVAR(lrfLastTargetASL), []];
|
||||||
|
player setVariable [QGVAR(lrfLastSentAt), -1000];
|
||||||
|
};
|
||||||
@@ -2,7 +2,7 @@
|
|||||||
|
|
||||||
params ["_logic"];
|
params ["_logic"];
|
||||||
|
|
||||||
_socket_is_running = player getVariable [QGVAR(eudConnected), false];
|
private _socket_is_running = player getVariable [QGVAR(eudConnected), false];
|
||||||
|
|
||||||
if (_socket_is_running) exitWith {
|
if (_socket_is_running) exitWith {
|
||||||
["Socket is already running", "error", "UDP Socket"] call EFUNC(main,notify);
|
["Socket is already running", "error", "UDP Socket"] call EFUNC(main,notify);
|
||||||
@@ -11,21 +11,55 @@ if (_socket_is_running) exitWith {
|
|||||||
|
|
||||||
disableSerialization;
|
disableSerialization;
|
||||||
|
|
||||||
_udp_socket_instance_address = ctrlText 16961;
|
private _eud_address = ctrlText 16961;
|
||||||
_udp_socket_instance_port = ctrlText 16962;
|
private _gnss_port = ctrlText 16962;
|
||||||
|
private _mavlink_port = ctrlText 16967;
|
||||||
|
private _lrf_port = ctrlText 16971;
|
||||||
|
private _video_feed_url = ctrlText 16969;
|
||||||
|
|
||||||
_udp_socket_fulladdress = ((_udp_socket_instance_address) + ":" + (_udp_socket_instance_port));
|
private _udp_socket_fulladdress = _eud_address + ":" + _gnss_port;
|
||||||
|
private _mavlink_address = _eud_address + ":" + _mavlink_port;
|
||||||
|
private _lrf_port_trimmed = trim _lrf_port;
|
||||||
|
private _lrf_enabled = _lrf_port_trimmed isNotEqualTo "";
|
||||||
|
private _lrf_address = _eud_address + ":" + _lrf_port_trimmed;
|
||||||
|
|
||||||
player setVariable [QGVAR(udp_socket_address), _udp_socket_fulladdress];
|
player setVariable [QGVAR(udp_socket_address), _udp_socket_fulladdress];
|
||||||
player setVariable [QGVAR(eudConnected), true];
|
player setVariable [QGVAR(mavlink_address), _mavlink_address];
|
||||||
|
player setVariable [QGVAR(lrf_address), _lrf_address];
|
||||||
|
player setVariable [QGVAR(lrfEnabled), _lrf_enabled];
|
||||||
|
player setVariable [QGVAR(lrfWasActive), false];
|
||||||
|
player setVariable [QGVAR(lrfLostAt), -1];
|
||||||
|
player setVariable [QGVAR(lrfClearSent), false];
|
||||||
|
player setVariable [QGVAR(lrfLastTargetASL), []];
|
||||||
|
player setVariable [QGVAR(lrfLastSentAt), -1000];
|
||||||
|
player setVariable [QGVAR(video_feed_url), trim _video_feed_url];
|
||||||
|
player setVariable [QGVAR(eudConnected), true, true];
|
||||||
|
|
||||||
|
private _advertised_video_uri = [objNull] call EFUNC(uav,resolveVideoUri);
|
||||||
|
|
||||||
"armatak" callExtension ["udp_socket:start", [_udp_socket_fulladdress]];
|
"armatak" callExtension ["udp_socket:start", [_udp_socket_fulladdress]];
|
||||||
|
"armatak" callExtension ["uas:start_endpoint", [parseNumber _mavlink_port]];
|
||||||
|
if (_lrf_enabled) then {
|
||||||
|
"armatak" callExtension ["udp_socket:start_lrf", [_lrf_address]];
|
||||||
|
};
|
||||||
|
|
||||||
|
private _mdnsInstanceName = format ["ArmaTAK-%1", name player];
|
||||||
|
"armatak" callExtension ["mdns:start_uas_advertisement", [_mdnsInstanceName, parseNumber _mavlink_port, _advertised_video_uri]];
|
||||||
|
"armatak" callExtension ["log", [["info", format ["Client UDP socket started for %1, MAVLink target set to %2, LRF target set to %3 and advertised video URI set to %4. Digital pointer uses ATAK LRF when enabled.", _udp_socket_fulladdress, _mavlink_address, _lrf_address, _advertised_video_uri]]]];
|
||||||
|
|
||||||
|
call EFUNC(uav,startMavlinkBroadcast);
|
||||||
|
|
||||||
[{
|
[{
|
||||||
if (player getVariable [QGVAR(eudConnected), false]) then {
|
if !(player getVariable [QGVAR(eudConnected), false]) exitWith {};
|
||||||
"armatak" callExtension ["udp_socket:send_gps_cot", [player call FUNC(extractClientPosition)]];
|
|
||||||
};
|
"armatak" callExtension ["udp_socket:send_gps_cot", [player call FUNC(extractClientPosition)]];
|
||||||
}, 0.5, []] call CBA_fnc_addPerFrameHandler;
|
}, 0.5, []] call CBA_fnc_addPerFrameHandler;
|
||||||
|
|
||||||
|
[{
|
||||||
|
if !(player getVariable [QGVAR(eudConnected), false]) exitWith {};
|
||||||
|
|
||||||
|
[player] call FUNC(sendLaserRangeFinder);
|
||||||
|
}, 0.25, []] call CBA_fnc_addPerFrameHandler;
|
||||||
|
|
||||||
deleteVehicle _logic;
|
deleteVehicle _logic;
|
||||||
closeDialog 1;
|
closeDialog 1;
|
||||||
|
|||||||
@@ -78,6 +78,16 @@ class Cfg3den {
|
|||||||
condition = "objectVehicle";
|
condition = "objectVehicle";
|
||||||
typeName = "STRING";
|
typeName = "STRING";
|
||||||
};
|
};
|
||||||
|
class armatak_attribute_marker_video_url {
|
||||||
|
displayName = "Video Feed URL";
|
||||||
|
tooltip = "Shared UAV video URL. This per-vehicle value overrides the optional session video URL from Connect to EUD.";
|
||||||
|
property = "armatak_attribute_marker_video_url";
|
||||||
|
control = "Edit";
|
||||||
|
expression = "_this setVariable ['armatak_attribute_marker_video_url',_value]";
|
||||||
|
defaultValue = "''";
|
||||||
|
condition = "objectVehicle";
|
||||||
|
typeName = "STRING";
|
||||||
|
};
|
||||||
};
|
};
|
||||||
};
|
};
|
||||||
};
|
};
|
||||||
|
|||||||
@@ -19,6 +19,45 @@ class CfgFunctions {
|
|||||||
class send_marker_cot {
|
class send_marker_cot {
|
||||||
file = "\armatak\armatak\addons\main\functions\api\fn_send_marker_cot.sqf";
|
file = "\armatak\armatak\addons\main\functions\api\fn_send_marker_cot.sqf";
|
||||||
};
|
};
|
||||||
|
class report_marker {
|
||||||
|
file = "\armatak\armatak\addons\main\functions\api\fn_report_marker.sqf";
|
||||||
|
};
|
||||||
|
class register_cot {
|
||||||
|
file = "\armatak\armatak\addons\main\functions\api\fn_register_cot.sqf";
|
||||||
|
};
|
||||||
|
class delete_registered_cots {
|
||||||
|
file = "\armatak\armatak\addons\main\functions\api\fn_delete_registered_cots.sqf";
|
||||||
|
};
|
||||||
|
class draw_circle {
|
||||||
|
file = "\armatak\armatak\addons\main\functions\api\fn_draw_circle.sqf";
|
||||||
|
};
|
||||||
|
class draw_ellipse {
|
||||||
|
file = "\armatak\armatak\addons\main\functions\api\fn_draw_ellipse.sqf";
|
||||||
|
};
|
||||||
|
class draw_rectangle {
|
||||||
|
file = "\armatak\armatak\addons\main\functions\api\fn_draw_rectangle.sqf";
|
||||||
|
};
|
||||||
|
class draw_polyline {
|
||||||
|
file = "\armatak\armatak\addons\main\functions\api\fn_draw_polyline.sqf";
|
||||||
|
};
|
||||||
|
class draw_route {
|
||||||
|
file = "\armatak\armatak\addons\main\functions\api\fn_draw_route.sqf";
|
||||||
|
};
|
||||||
|
class draw_tactical_graphic {
|
||||||
|
file = "\armatak\armatak\addons\main\functions\api\fn_draw_tactical_graphic.sqf";
|
||||||
|
};
|
||||||
|
class send_uas_platform_cot {
|
||||||
|
file = "\armatak\armatak\addons\main\functions\api\fn_send_uas_platform_cot.sqf";
|
||||||
|
};
|
||||||
|
class send_uas_video_cot {
|
||||||
|
file = "\armatak\armatak\addons\main\functions\api\fn_send_uas_video_cot.sqf";
|
||||||
|
};
|
||||||
|
class send_uas_sensor_cot {
|
||||||
|
file = "\armatak\armatak\addons\main\functions\api\fn_send_uas_sensor_cot.sqf";
|
||||||
|
};
|
||||||
|
class set_uas_camera_override {
|
||||||
|
file = "\armatak\armatak\addons\main\functions\api\fn_set_uas_camera_override.sqf";
|
||||||
|
};
|
||||||
class stop_tcp_socket {
|
class stop_tcp_socket {
|
||||||
file = "\armatak\armatak\addons\main\functions\api\fn_stop_tcp_socket.sqf";
|
file = "\armatak\armatak\addons\main\functions\api\fn_stop_tcp_socket.sqf";
|
||||||
};
|
};
|
||||||
@@ -31,12 +70,18 @@ class CfgFunctions {
|
|||||||
class extract_marker_callsign {
|
class extract_marker_callsign {
|
||||||
file = "\armatak\armatak\addons\main\functions\extract_data\fn_extract_marker_callsign.sqf";
|
file = "\armatak\armatak\addons\main\functions\extract_data\fn_extract_marker_callsign.sqf";
|
||||||
};
|
};
|
||||||
|
class extract_marker_video_url {
|
||||||
|
file = "\armatak\armatak\addons\main\functions\extract_data\fn_extract_marker_video_url.sqf";
|
||||||
|
};
|
||||||
class extract_role {
|
class extract_role {
|
||||||
file = "\armatak\armatak\addons\main\functions\extract_data\fn_extract_role.sqf";
|
file = "\armatak\armatak\addons\main\functions\extract_data\fn_extract_role.sqf";
|
||||||
};
|
};
|
||||||
class extract_sensor_data {
|
class extract_sensor_data {
|
||||||
file = "\armatak\armatak\addons\main\functions\extract_data\fn_extract_sensor_data.sqf";
|
file = "\armatak\armatak\addons\main\functions\extract_data\fn_extract_sensor_data.sqf";
|
||||||
};
|
};
|
||||||
|
class extract_uas_camera_data {
|
||||||
|
file = "\armatak\armatak\addons\main\functions\extract_data\fn_extract_uas_camera_data.sqf";
|
||||||
|
};
|
||||||
class extract_unit_callsign {
|
class extract_unit_callsign {
|
||||||
file = "\armatak\armatak\addons\main\functions\extract_data\fn_extract_unit_callsign.sqf";
|
file = "\armatak\armatak\addons\main\functions\extract_data\fn_extract_unit_callsign.sqf";
|
||||||
};
|
};
|
||||||
@@ -122,6 +167,9 @@ class CfgFunctions {
|
|||||||
class convert_to_rut_mandol {
|
class convert_to_rut_mandol {
|
||||||
file = "\armatak\armatak\addons\main\functions\map\fn_convert_to_rut_mandol.sqf";
|
file = "\armatak\armatak\addons\main\functions\map\fn_convert_to_rut_mandol.sqf";
|
||||||
};
|
};
|
||||||
|
class convert_to_hellanmaa {
|
||||||
|
file = "\armatak\armatak\addons\main\functions\map\fn_convert_to_hellanmaa.sqf";
|
||||||
|
};
|
||||||
};
|
};
|
||||||
};
|
};
|
||||||
};
|
};
|
||||||
|
|||||||
@@ -9,10 +9,14 @@ addMissionEventHandler ["ExtensionCallback", {
|
|||||||
|
|
||||||
switch (_function) do {
|
switch (_function) do {
|
||||||
case "EUD Connected": {
|
case "EUD Connected": {
|
||||||
SETVAR(player,EGVAR(client,eudConnected),true);
|
player setVariable [QEGVAR(client,eudConnected), true, true];
|
||||||
};
|
};
|
||||||
case "EUD Disconnected": {
|
case "EUD Disconnected": {
|
||||||
SETVAR(player,EGVAR(client,eudConnected),false);
|
player setVariable [QEGVAR(client,eudConnected), false, true];
|
||||||
|
SETVAR(player,EGVAR(client,lrfEnabled),false);
|
||||||
|
call EFUNC(uav,stopMavlinkBroadcast);
|
||||||
|
"armatak" callExtension ["uas:stop_endpoint", []];
|
||||||
|
"armatak" callExtension ["mdns:stop", []];
|
||||||
};
|
};
|
||||||
default {};
|
default {};
|
||||||
};
|
};
|
||||||
@@ -24,11 +28,55 @@ addMissionEventHandler ["ExtensionCallback", {
|
|||||||
[_function, "error", _name] call FUNC(notify);
|
[_function, "error", _name] call FUNC(notify);
|
||||||
|
|
||||||
if (_function == "UDP Socket is not running") then {
|
if (_function == "UDP Socket is not running") then {
|
||||||
SETVAR(player,EGVAR(client,eudConnected),false);
|
player setVariable [QEGVAR(client,eudConnected), false, true];
|
||||||
|
SETVAR(player,EGVAR(client,lrfEnabled),false);
|
||||||
|
call EFUNC(uav,stopMavlinkBroadcast);
|
||||||
|
"armatak" callExtension ["uas:stop_endpoint", []];
|
||||||
|
"armatak" callExtension ["mdns:stop", []];
|
||||||
};
|
};
|
||||||
|
|
||||||
if (_function == "failed to bind UDP socket") then {
|
if (_function == "failed to bind UDP socket") then {
|
||||||
SETVAR(player,EGVAR(client,eudConnected),false);
|
player setVariable [QEGVAR(client,eudConnected), false, true];
|
||||||
|
SETVAR(player,EGVAR(client,lrfEnabled),false);
|
||||||
|
call EFUNC(uav,stopMavlinkBroadcast);
|
||||||
|
"armatak" callExtension ["uas:stop_endpoint", []];
|
||||||
|
"armatak" callExtension ["mdns:stop", []];
|
||||||
|
};
|
||||||
|
};
|
||||||
|
case "MAVLINK UDP ERROR": {
|
||||||
|
_message = _function;
|
||||||
|
if (_data isNotEqualTo "") then {
|
||||||
|
_message = format ["%1: %2", _function, _data];
|
||||||
|
};
|
||||||
|
|
||||||
|
[_message, "warning", _name] call FUNC(notify);
|
||||||
|
};
|
||||||
|
case "MAVLINK UDP": {
|
||||||
|
private _history = missionNamespace getVariable ["armatak_uav_mavlink_callback_history", []];
|
||||||
|
_history pushBack [diag_tickTime, _function, _data];
|
||||||
|
if ((count _history) > 50) then {
|
||||||
|
_history deleteRange [0, (count _history) - 50];
|
||||||
|
};
|
||||||
|
missionNamespace setVariable ["armatak_uav_mavlink_callback_history", _history];
|
||||||
|
missionNamespace setVariable ["armatak_uav_last_mavlink_callback", [diag_tickTime, _function, _data]];
|
||||||
|
|
||||||
|
switch (_function) do {
|
||||||
|
case "COMMAND_LONG";
|
||||||
|
case "COMMAND_INT";
|
||||||
|
case "COMMAND_ACK";
|
||||||
|
case "MISSION_COUNT";
|
||||||
|
case "MISSION_ITEM";
|
||||||
|
case "MISSION_ITEM_INT";
|
||||||
|
case "MISSION_CLEAR_ALL";
|
||||||
|
case "MISSION_SET_CURRENT";
|
||||||
|
case "SET_HOME_POSITION";
|
||||||
|
case "SET_MODE";
|
||||||
|
case "SET_POSITION_TARGET_GLOBAL_INT";
|
||||||
|
case "MANUAL_CONTROL": {
|
||||||
|
"armatak" callExtension ["log", [["info", format ["MAVLINK UDP CALLBACK %1 %2", _function, _data]]]];
|
||||||
|
[_function, _data] call EFUNC(uav,handleMavlinkCallback);
|
||||||
|
};
|
||||||
|
default {};
|
||||||
};
|
};
|
||||||
};
|
};
|
||||||
case "TCP SOCKET": {
|
case "TCP SOCKET": {
|
||||||
@@ -45,6 +93,12 @@ addMissionEventHandler ["ExtensionCallback", {
|
|||||||
case "VIDEO": {
|
case "VIDEO": {
|
||||||
[_function, "success", _name] call FUNC(notify);
|
[_function, "success", _name] call FUNC(notify);
|
||||||
};
|
};
|
||||||
|
case "MDNS": {
|
||||||
|
[_function, "success", _name] call FUNC(notify);
|
||||||
|
};
|
||||||
|
case "MDNS ERROR": {
|
||||||
|
[_function, "warning", _name] call FUNC(notify);
|
||||||
|
};
|
||||||
case "VIDEO ERROR": {
|
case "VIDEO ERROR": {
|
||||||
[_function, "error", _name] call FUNC(notify);
|
[_function, "error", _name] call FUNC(notify);
|
||||||
|
|
||||||
|
|||||||
@@ -0,0 +1,36 @@
|
|||||||
|
// function name: armatak_fnc_delete_registered_cots
|
||||||
|
// function author: Valmo, Codex
|
||||||
|
// function description: Sends forced delete CoTs for all registered CoTs in a scope.
|
||||||
|
//
|
||||||
|
// Arguments:
|
||||||
|
// 0: Scope/key used to group CoTs <STRING>
|
||||||
|
//
|
||||||
|
// Return Value:
|
||||||
|
// Number of delete CoTs sent <NUMBER>
|
||||||
|
//
|
||||||
|
// Public: Yes
|
||||||
|
|
||||||
|
params [
|
||||||
|
["_scope", "", [""]]
|
||||||
|
];
|
||||||
|
|
||||||
|
if (_scope isEqualTo "") exitWith {0};
|
||||||
|
|
||||||
|
private _registry = missionNamespace getVariable ["armatak_registered_cots", []];
|
||||||
|
private _remaining = [];
|
||||||
|
private _deleted = 0;
|
||||||
|
|
||||||
|
{
|
||||||
|
_x params ["_registeredScope", "_uid", "_type", "_lat", "_lon", "_hae"];
|
||||||
|
|
||||||
|
if (_registeredScope isEqualTo _scope) then {
|
||||||
|
"armatak" callExtension ["tcp_socket:cot:delete", [[_uid, _type, _lat, _lon, _hae]]];
|
||||||
|
_deleted = _deleted + 1;
|
||||||
|
} else {
|
||||||
|
_remaining pushBack _x;
|
||||||
|
};
|
||||||
|
} forEach _registry;
|
||||||
|
|
||||||
|
missionNamespace setVariable ["armatak_registered_cots", _remaining];
|
||||||
|
|
||||||
|
_deleted
|
||||||
@@ -0,0 +1,44 @@
|
|||||||
|
// function name: armatak_fnc_draw_circle
|
||||||
|
// function author: Valmo
|
||||||
|
// function description: Sends an ATAK Drawing Tools circle CoT.
|
||||||
|
//
|
||||||
|
// Arguments:
|
||||||
|
// 0: Center position or object <ARRAY|OBJECT>
|
||||||
|
// 1: Radius in meters <NUMBER>
|
||||||
|
// 2: Callsign/title <STRING> (default: "ArmaTAK Circle")
|
||||||
|
// 3: Stale time in seconds <NUMBER> (default: 86400)
|
||||||
|
// 4: Stroke color as signed ARGB int <NUMBER> (default: -1)
|
||||||
|
// 5: Fill color as signed ARGB int <NUMBER> (default: -1761607681)
|
||||||
|
// 6: Stroke weight <NUMBER> (default: 3)
|
||||||
|
// 7: Optional registration scope <STRING> (default: "")
|
||||||
|
//
|
||||||
|
// Example:
|
||||||
|
// [player, 300, "Mortar Risk Area"] call armatak_fnc_draw_circle;
|
||||||
|
//
|
||||||
|
// Public: Yes
|
||||||
|
|
||||||
|
params [
|
||||||
|
["_center", objNull, [objNull, []]],
|
||||||
|
["_radius", 100, [0]],
|
||||||
|
["_callsign", "ArmaTAK Circle", [""]],
|
||||||
|
["_staleSeconds", 86400, [0]],
|
||||||
|
["_strokeColor", -1, [0]],
|
||||||
|
["_fillColor", -1761607681, [0]],
|
||||||
|
["_strokeWeight", 3, [0]],
|
||||||
|
["_scope", "", [""]]
|
||||||
|
];
|
||||||
|
|
||||||
|
[
|
||||||
|
_center,
|
||||||
|
_radius,
|
||||||
|
_radius,
|
||||||
|
360,
|
||||||
|
_callsign,
|
||||||
|
_staleSeconds,
|
||||||
|
_strokeColor,
|
||||||
|
_fillColor,
|
||||||
|
_strokeWeight,
|
||||||
|
"",
|
||||||
|
"u-d-c-c",
|
||||||
|
_scope
|
||||||
|
] call armatak_fnc_draw_ellipse;
|
||||||
@@ -0,0 +1,70 @@
|
|||||||
|
// function name: armatak_fnc_draw_ellipse
|
||||||
|
// function author: Valmo
|
||||||
|
// function description: Sends an ATAK Drawing Tools ellipse or circle CoT.
|
||||||
|
//
|
||||||
|
// Arguments:
|
||||||
|
// 0: Center position or object <ARRAY|OBJECT>
|
||||||
|
// 1: Major radius in meters <NUMBER>
|
||||||
|
// 2: Minor radius in meters <NUMBER>
|
||||||
|
// 3: Rotation angle in degrees <NUMBER> (default: 0)
|
||||||
|
// 4: Callsign/title <STRING> (default: "ArmaTAK Ellipse")
|
||||||
|
// 5: Stale time in seconds <NUMBER> (default: 86400)
|
||||||
|
// 6: Stroke color as signed ARGB int <NUMBER> (default: -1)
|
||||||
|
// 7: Fill color as signed ARGB int <NUMBER> (default: -1761607681)
|
||||||
|
// 8: Stroke weight <NUMBER> (default: 3)
|
||||||
|
// 9: MilSym SIDC for tactical overlay <STRING> (default: "")
|
||||||
|
// 10: CoT type <STRING> (default: "u-d-c-e")
|
||||||
|
// 11: Optional registration scope <STRING> (default: "")
|
||||||
|
//
|
||||||
|
// Example:
|
||||||
|
// [screenToWorld [0.5, 0.5], 250, 100, 45, "Support by Fire"] call armatak_fnc_draw_ellipse;
|
||||||
|
//
|
||||||
|
// Public: Yes
|
||||||
|
|
||||||
|
params [
|
||||||
|
["_center", objNull, [objNull, []]],
|
||||||
|
["_major", 100, [0]],
|
||||||
|
["_minor", 50, [0]],
|
||||||
|
["_angle", 0, [0]],
|
||||||
|
["_callsign", "ArmaTAK Ellipse", [""]],
|
||||||
|
["_staleSeconds", 86400, [0]],
|
||||||
|
["_strokeColor", -1, [0]],
|
||||||
|
["_fillColor", -1761607681, [0]],
|
||||||
|
["_strokeWeight", 3, [0]],
|
||||||
|
["_milsym", "", [""]],
|
||||||
|
["_cotType", "u-d-c-e", [""]],
|
||||||
|
["_scope", "", [""]]
|
||||||
|
];
|
||||||
|
|
||||||
|
private _position = if (_center isEqualType objNull) then {
|
||||||
|
getPos _center
|
||||||
|
} else {
|
||||||
|
_center
|
||||||
|
};
|
||||||
|
|
||||||
|
if ((count _position) < 2) exitWith {""};
|
||||||
|
|
||||||
|
private _altitude = _position param [2, 0, [0]];
|
||||||
|
private _realLocation = [_position select 0, _position select 1, _altitude] call armatak_client_fnc_convertClientLocation;
|
||||||
|
private _uuid = "armatak" callExtension ["uuid", []] select 0;
|
||||||
|
private _payload = [
|
||||||
|
_uuid,
|
||||||
|
_cotType,
|
||||||
|
_realLocation select 0,
|
||||||
|
_realLocation select 1,
|
||||||
|
_realLocation select 2,
|
||||||
|
_major max 1,
|
||||||
|
_minor max 1,
|
||||||
|
_angle,
|
||||||
|
_callsign,
|
||||||
|
_staleSeconds max 1,
|
||||||
|
_strokeColor,
|
||||||
|
_fillColor,
|
||||||
|
_strokeWeight max 1,
|
||||||
|
_milsym
|
||||||
|
];
|
||||||
|
|
||||||
|
"armatak" callExtension ["tcp_socket:draw:ellipse", [_payload]];
|
||||||
|
[_scope, _uuid, _cotType, _realLocation select 0, _realLocation select 1, _realLocation select 2] call armatak_fnc_register_cot;
|
||||||
|
|
||||||
|
_uuid
|
||||||
@@ -0,0 +1,83 @@
|
|||||||
|
// function name: armatak_fnc_draw_polyline
|
||||||
|
// function author: Valmo
|
||||||
|
// function description: Sends an ATAK Drawing Tools freeform line or polygon CoT.
|
||||||
|
//
|
||||||
|
// Arguments:
|
||||||
|
// 0: Positions or objects <ARRAY>
|
||||||
|
// 1: Callsign/title <STRING> (default: "ArmaTAK Line")
|
||||||
|
// 2: Closed polygon <BOOL> (default: false)
|
||||||
|
// 3: Stale time in seconds <NUMBER> (default: 86400)
|
||||||
|
// 4: Stroke color as signed ARGB int <NUMBER> (default: -1)
|
||||||
|
// 5: Fill color as signed ARGB int <NUMBER> (default: -1761607681)
|
||||||
|
// 6: Stroke weight <NUMBER> (default: 3)
|
||||||
|
// 7: Stroke style <STRING> (default: "solid")
|
||||||
|
// 8: MilSym SIDC for tactical overlay <STRING> (default: "")
|
||||||
|
// 9: CoT type <STRING> (default: "u-d-f")
|
||||||
|
// 10: Optional registration scope <STRING> (default: "")
|
||||||
|
//
|
||||||
|
// Example:
|
||||||
|
// [[pos player, screenToWorld [0.5, 0.5]], "Phase Line Blue"] call armatak_fnc_draw_polyline;
|
||||||
|
//
|
||||||
|
// Public: Yes
|
||||||
|
|
||||||
|
params [
|
||||||
|
["_points", [], [[]]],
|
||||||
|
["_callsign", "ArmaTAK Line", [""]],
|
||||||
|
["_closed", false, [true]],
|
||||||
|
["_staleSeconds", 86400, [0]],
|
||||||
|
["_strokeColor", -1, [0]],
|
||||||
|
["_fillColor", -1761607681, [0]],
|
||||||
|
["_strokeWeight", 3, [0]],
|
||||||
|
["_strokeStyle", "solid", [""]],
|
||||||
|
["_milsym", "", [""]],
|
||||||
|
["_cotType", "u-d-f", [""]],
|
||||||
|
["_scope", "", [""]]
|
||||||
|
];
|
||||||
|
|
||||||
|
if ((count _points) < 2) exitWith {""};
|
||||||
|
|
||||||
|
private _pointStrings = [];
|
||||||
|
private _center = [];
|
||||||
|
|
||||||
|
{
|
||||||
|
private _position = if (_x isEqualType objNull) then {
|
||||||
|
getPos _x
|
||||||
|
} else {
|
||||||
|
_x
|
||||||
|
};
|
||||||
|
|
||||||
|
if ((count _position) >= 2) then {
|
||||||
|
private _altitude = _position param [2, 0, [0]];
|
||||||
|
private _realLocation = [_position select 0, _position select 1, _altitude] call armatak_client_fnc_convertClientLocation;
|
||||||
|
_pointStrings pushBack format ["%1,%2,%3", _realLocation select 0, _realLocation select 1, _realLocation select 2];
|
||||||
|
|
||||||
|
if (_center isEqualTo []) then {
|
||||||
|
_center = _realLocation;
|
||||||
|
};
|
||||||
|
};
|
||||||
|
} forEach _points;
|
||||||
|
|
||||||
|
if ((count _pointStrings) < 2) exitWith {""};
|
||||||
|
|
||||||
|
private _uuid = "armatak" callExtension ["uuid", []] select 0;
|
||||||
|
private _payload = [
|
||||||
|
_uuid,
|
||||||
|
_cotType,
|
||||||
|
_center select 0,
|
||||||
|
_center select 1,
|
||||||
|
_center select 2,
|
||||||
|
_pointStrings joinString ";",
|
||||||
|
_callsign,
|
||||||
|
_staleSeconds max 1,
|
||||||
|
_strokeColor,
|
||||||
|
_fillColor,
|
||||||
|
_strokeWeight max 1,
|
||||||
|
_strokeStyle,
|
||||||
|
_closed,
|
||||||
|
_milsym
|
||||||
|
];
|
||||||
|
|
||||||
|
"armatak" callExtension ["tcp_socket:draw:free", [_payload]];
|
||||||
|
[_scope, _uuid, _cotType, _center select 0, _center select 1, _center select 2] call armatak_fnc_register_cot;
|
||||||
|
|
||||||
|
_uuid
|
||||||
@@ -0,0 +1,94 @@
|
|||||||
|
// function name: armatak_fnc_draw_rectangle
|
||||||
|
// function author: Valmo
|
||||||
|
// function description: Sends an ATAK Drawing Tools rectangle CoT from an Arma center, width, length, and bearing.
|
||||||
|
//
|
||||||
|
// Arguments:
|
||||||
|
// 0: Center position or object <ARRAY|OBJECT>
|
||||||
|
// 1: Width in meters <NUMBER>
|
||||||
|
// 2: Length in meters <NUMBER>
|
||||||
|
// 3: Bearing in degrees <NUMBER> (default: 0)
|
||||||
|
// 4: Callsign/title <STRING> (default: "ArmaTAK Rectangle")
|
||||||
|
// 5: Stale time in seconds <NUMBER> (default: 86400)
|
||||||
|
// 6: Stroke color as signed ARGB int <NUMBER> (default: -1)
|
||||||
|
// 7: Fill color as signed ARGB int <NUMBER> (default: -1761607681)
|
||||||
|
// 8: Stroke weight <NUMBER> (default: 3)
|
||||||
|
// 9: MilSym SIDC for tactical overlay <STRING> (default: "")
|
||||||
|
// 10: Optional registration scope <STRING> (default: "")
|
||||||
|
//
|
||||||
|
// Example:
|
||||||
|
// [screenToWorld [0.5, 0.5], 200, 500, 30, "Engagement Area"] call armatak_fnc_draw_rectangle;
|
||||||
|
//
|
||||||
|
// Public: Yes
|
||||||
|
|
||||||
|
params [
|
||||||
|
["_center", objNull, [objNull, []]],
|
||||||
|
["_width", 100, [0]],
|
||||||
|
["_length", 100, [0]],
|
||||||
|
["_bearing", 0, [0]],
|
||||||
|
["_callsign", "ArmaTAK Rectangle", [""]],
|
||||||
|
["_staleSeconds", 86400, [0]],
|
||||||
|
["_strokeColor", -1, [0]],
|
||||||
|
["_fillColor", -1761607681, [0]],
|
||||||
|
["_strokeWeight", 3, [0]],
|
||||||
|
["_milsym", "", [""]],
|
||||||
|
["_scope", "", [""]]
|
||||||
|
];
|
||||||
|
|
||||||
|
private _centerPos = if (_center isEqualType objNull) then {
|
||||||
|
getPos _center
|
||||||
|
} else {
|
||||||
|
_center
|
||||||
|
};
|
||||||
|
|
||||||
|
if ((count _centerPos) < 2) exitWith {""};
|
||||||
|
|
||||||
|
private _altitude = _centerPos param [2, 0, [0]];
|
||||||
|
private _halfWidth = (_width max 1) / 2;
|
||||||
|
private _halfLength = (_length max 1) / 2;
|
||||||
|
private _sin = sin _bearing;
|
||||||
|
private _cos = cos _bearing;
|
||||||
|
private _forward = [_sin, _cos, 0];
|
||||||
|
private _right = [_cos, -_sin, 0];
|
||||||
|
private _offsets = [
|
||||||
|
[(_right vectorMultiply -_halfWidth), (_forward vectorMultiply _halfLength)],
|
||||||
|
[(_right vectorMultiply _halfWidth), (_forward vectorMultiply _halfLength)],
|
||||||
|
[(_right vectorMultiply _halfWidth), (_forward vectorMultiply -_halfLength)],
|
||||||
|
[(_right vectorMultiply -_halfWidth), (_forward vectorMultiply -_halfLength)]
|
||||||
|
];
|
||||||
|
private _points = [];
|
||||||
|
|
||||||
|
{
|
||||||
|
private _offset = (_x select 0) vectorAdd (_x select 1);
|
||||||
|
_points pushBack ([_centerPos select 0, _centerPos select 1, _altitude] vectorAdd _offset);
|
||||||
|
} forEach _offsets;
|
||||||
|
|
||||||
|
private _centerReal = [_centerPos select 0, _centerPos select 1, _altitude] call armatak_client_fnc_convertClientLocation;
|
||||||
|
private _pointStrings = [];
|
||||||
|
|
||||||
|
{
|
||||||
|
private _realLocation = [_x select 0, _x select 1, _x select 2] call armatak_client_fnc_convertClientLocation;
|
||||||
|
_pointStrings pushBack format ["%1,%2,%3", _realLocation select 0, _realLocation select 1, _realLocation select 2];
|
||||||
|
} forEach _points;
|
||||||
|
|
||||||
|
private _uuid = "armatak" callExtension ["uuid", []] select 0;
|
||||||
|
private _payload = [
|
||||||
|
_uuid,
|
||||||
|
"u-d-r",
|
||||||
|
_centerReal select 0,
|
||||||
|
_centerReal select 1,
|
||||||
|
_centerReal select 2,
|
||||||
|
_pointStrings joinString ";",
|
||||||
|
_callsign,
|
||||||
|
_staleSeconds max 1,
|
||||||
|
_strokeColor,
|
||||||
|
_fillColor,
|
||||||
|
_strokeWeight max 1,
|
||||||
|
"solid",
|
||||||
|
false,
|
||||||
|
_milsym
|
||||||
|
];
|
||||||
|
|
||||||
|
"armatak" callExtension ["tcp_socket:draw:rectangle", [_payload]];
|
||||||
|
[_scope, _uuid, "u-d-r", _centerReal select 0, _centerReal select 1, _centerReal select 2] call armatak_fnc_register_cot;
|
||||||
|
|
||||||
|
_uuid
|
||||||
@@ -0,0 +1,200 @@
|
|||||||
|
// function name: armatak_fnc_draw_route
|
||||||
|
// function author: Valmo
|
||||||
|
// function description: Sends an ATAK navigable route CoT.
|
||||||
|
//
|
||||||
|
// Arguments:
|
||||||
|
// 0: Positions or objects <ARRAY>
|
||||||
|
// 1: Callsign/title <STRING> (default: "ArmaTAK Route")
|
||||||
|
// 2: Stale time in seconds <NUMBER> (default: 86400)
|
||||||
|
// 3: Color as signed ARGB int <NUMBER> (default: -1)
|
||||||
|
// 4: Stroke weight <NUMBER> (default: 3)
|
||||||
|
// 5: Navigation method <STRING> (default: "Driving")
|
||||||
|
// 6: Route type <STRING> (default: "Primary")
|
||||||
|
// 7: Direction/planning method <STRING> (default: "Infil")
|
||||||
|
// 8: Checkpoint interval among route points <NUMBER> (default: 5)
|
||||||
|
// 9: Optional registration scope <STRING> (default: "")
|
||||||
|
//
|
||||||
|
// Example:
|
||||||
|
// [[pos player, screenToWorld [0.5, 0.5]], "Patrol Route"] call armatak_fnc_draw_route;
|
||||||
|
//
|
||||||
|
// Public: Yes
|
||||||
|
|
||||||
|
params [
|
||||||
|
["_points", [], [[]]],
|
||||||
|
["_callsign", "ArmaTAK Route", [""]],
|
||||||
|
["_staleSeconds", 86400, [0]],
|
||||||
|
["_color", -1, [0]],
|
||||||
|
["_strokeWeight", 3, [0]],
|
||||||
|
["_method", "Driving", [""]],
|
||||||
|
["_routeType", "Primary", [""]],
|
||||||
|
["_direction", "Infil", [""]],
|
||||||
|
["_checkpointInterval", 5, [0]],
|
||||||
|
["_scope", "", [""]]
|
||||||
|
];
|
||||||
|
|
||||||
|
if ((count _points) < 2) exitWith {""};
|
||||||
|
|
||||||
|
private _pointStrings = [];
|
||||||
|
|
||||||
|
{
|
||||||
|
private _position = if (_x isEqualType objNull) then {
|
||||||
|
getPos _x
|
||||||
|
} else {
|
||||||
|
_x
|
||||||
|
};
|
||||||
|
|
||||||
|
if ((count _position) >= 2) then {
|
||||||
|
private _altitude = _position param [2, 0, [0]];
|
||||||
|
private _realLocation = [_position select 0, _position select 1, _altitude] call armatak_client_fnc_convertClientLocation;
|
||||||
|
_pointStrings pushBack format ["%1,%2,%3", _realLocation select 0, _realLocation select 1, _realLocation select 2];
|
||||||
|
};
|
||||||
|
} forEach _points;
|
||||||
|
|
||||||
|
if ((count _pointStrings) < 2) exitWith {""};
|
||||||
|
|
||||||
|
private _uuid = "armatak" callExtension ["uuid", []] select 0;
|
||||||
|
private _pad = {
|
||||||
|
params ["_value", "_digits"];
|
||||||
|
|
||||||
|
private _text = str (floor _value);
|
||||||
|
while {(count _text) < _digits} do {
|
||||||
|
_text = "0" + _text;
|
||||||
|
};
|
||||||
|
|
||||||
|
_text
|
||||||
|
};
|
||||||
|
|
||||||
|
private _formatCotTime = {
|
||||||
|
params ["_dateParts"];
|
||||||
|
|
||||||
|
format [
|
||||||
|
"%1-%2-%3T%4:%5:%6.%7Z",
|
||||||
|
_dateParts param [0, 1970, [0]],
|
||||||
|
[_dateParts param [1, 1, [0]], 2] call _pad,
|
||||||
|
[_dateParts param [2, 1, [0]], 2] call _pad,
|
||||||
|
[_dateParts param [3, 0, [0]], 2] call _pad,
|
||||||
|
[_dateParts param [4, 0, [0]], 2] call _pad,
|
||||||
|
[_dateParts param [5, 0, [0]], 2] call _pad,
|
||||||
|
[_dateParts param [6, 0, [0]], 3] call _pad
|
||||||
|
]
|
||||||
|
};
|
||||||
|
|
||||||
|
private _addSecondsUtc = {
|
||||||
|
params ["_dateParts", "_secondsToAdd"];
|
||||||
|
|
||||||
|
private _year = _dateParts param [0, 1970, [0]];
|
||||||
|
private _month = _dateParts param [1, 1, [0]];
|
||||||
|
private _day = _dateParts param [2, 1, [0]];
|
||||||
|
private _hour = _dateParts param [3, 0, [0]];
|
||||||
|
private _minute = _dateParts param [4, 0, [0]];
|
||||||
|
private _second = (_dateParts param [5, 0, [0]]) + (floor _secondsToAdd);
|
||||||
|
private _millisecond = _dateParts param [6, 0, [0]];
|
||||||
|
|
||||||
|
while {_second >= 60} do {
|
||||||
|
_second = _second - 60;
|
||||||
|
_minute = _minute + 1;
|
||||||
|
};
|
||||||
|
while {_minute >= 60} do {
|
||||||
|
_minute = _minute - 60;
|
||||||
|
_hour = _hour + 1;
|
||||||
|
};
|
||||||
|
while {_hour >= 24} do {
|
||||||
|
_hour = _hour - 24;
|
||||||
|
_day = _day + 1;
|
||||||
|
|
||||||
|
private _daysInMonth = [31, 28, 31, 30, 31, 30, 31, 31, 30, 31, 30, 31];
|
||||||
|
private _isLeapYear = ((_year mod 4) isEqualTo 0) && {((_year mod 100) isNotEqualTo 0) || {(_year mod 400) isEqualTo 0}};
|
||||||
|
if (_isLeapYear) then {_daysInMonth set [1, 29];};
|
||||||
|
|
||||||
|
if (_day > (_daysInMonth select (_month - 1))) then {
|
||||||
|
_day = 1;
|
||||||
|
_month = _month + 1;
|
||||||
|
if (_month > 12) then {
|
||||||
|
_month = 1;
|
||||||
|
_year = _year + 1;
|
||||||
|
};
|
||||||
|
};
|
||||||
|
};
|
||||||
|
|
||||||
|
[_year, _month, _day, _hour, _minute, _second, _millisecond]
|
||||||
|
};
|
||||||
|
|
||||||
|
private _nowDate = systemTimeUTC;
|
||||||
|
private _now = [_nowDate] call _formatCotTime;
|
||||||
|
private _stale = [[_nowDate, _staleSeconds max 60] call _addSecondsUtc] call _formatCotTime;
|
||||||
|
|
||||||
|
private _links = "";
|
||||||
|
private _routeWaypoints = [];
|
||||||
|
private _lastIndex = (count _pointStrings) - 1;
|
||||||
|
private _checkpointNumber = 1;
|
||||||
|
private _checkpointIntervalSafe = _checkpointInterval max 1;
|
||||||
|
|
||||||
|
{
|
||||||
|
private _linkUuid = "armatak" callExtension ["uuid", []] select 0;
|
||||||
|
private _pointCallsign = "";
|
||||||
|
if (_forEachIndex isEqualTo 0) then {
|
||||||
|
_pointCallsign = format ["%1 SP", _callsign];
|
||||||
|
} else {
|
||||||
|
if (_forEachIndex isEqualTo _lastIndex) then {
|
||||||
|
_pointCallsign = "VDO";
|
||||||
|
} else {
|
||||||
|
if ((_forEachIndex mod _checkpointIntervalSafe) isEqualTo 0) then {
|
||||||
|
_pointCallsign = format ["CP%1", _checkpointNumber];
|
||||||
|
_checkpointNumber = _checkpointNumber + 1;
|
||||||
|
};
|
||||||
|
};
|
||||||
|
};
|
||||||
|
|
||||||
|
private _linkType = ["b-m-p-w", "b-m-p-c"] select (_pointCallsign isEqualTo "");
|
||||||
|
_links = _links + format [
|
||||||
|
"<link uid=""%1"" callsign=""%2"" type=""%3"" point=""%4"" remarks="""" relation=""c""/>",
|
||||||
|
_linkUuid,
|
||||||
|
_pointCallsign,
|
||||||
|
_linkType,
|
||||||
|
_x
|
||||||
|
];
|
||||||
|
|
||||||
|
if (_pointCallsign isNotEqualTo "") then {
|
||||||
|
_routeWaypoints pushBack [_linkUuid, _pointCallsign, _x];
|
||||||
|
};
|
||||||
|
} forEach _pointStrings;
|
||||||
|
|
||||||
|
private _xml = format [
|
||||||
|
"<?xml version=""1.0"" encoding=""UTF-8"" ?><event version=""2.0"" uid=""%1"" type=""b-m-r"" time=""%2"" start=""%2"" stale=""%3"" how=""h-e"" access=""Undefined""><point lat=""0.0"" lon=""0.0"" hae=""9999999.0"" ce=""9999999.0"" le=""9999999.0""/><detail>%4<link_attr planningmethod=""%5"" color=""%6"" method=""%7"" prefix=""CP"" style=""0"" type=""Vehicle"" stroke=""%8"" direction=""%5"" routetype=""%9"" order=""Ascending Check Points""/><creator uid=""ARMATAK"" callsign=""ArmaTAK"" time=""%2"" type=""a-f-G-U-C""/><strokeColor value=""%6""/><strokeWeight value=""%8""/><strokeStyle value=""solid""/><labels_on value=""false""/><__routeinfo><__navcues/></__routeinfo><color value=""%6""/><remarks/><contact callsign=""%10""/><archive/><height_unit>1</height_unit></detail></event>",
|
||||||
|
_uuid,
|
||||||
|
_now,
|
||||||
|
_stale,
|
||||||
|
_links,
|
||||||
|
_direction,
|
||||||
|
_color,
|
||||||
|
_method,
|
||||||
|
_strokeWeight max 1,
|
||||||
|
_routeType,
|
||||||
|
_callsign
|
||||||
|
];
|
||||||
|
|
||||||
|
"armatak" callExtension ["log", [["info", format ["Sending ATAK route '%1' with %2 points (%3 bytes)", _callsign, count _pointStrings, count _xml]]]];
|
||||||
|
"armatak" callExtension ["tcp_socket:send_payload", [_xml]];
|
||||||
|
[_scope, _uuid, "b-m-r", 0, 0, 9999999] call armatak_fnc_register_cot;
|
||||||
|
|
||||||
|
{
|
||||||
|
_x params ["_waypointUid", "_waypointCallsign", "_pointString"];
|
||||||
|
private _pointParts = _pointString splitString ",";
|
||||||
|
if ((count _pointParts) >= 3) then {
|
||||||
|
private _waypointXml = format [
|
||||||
|
"<?xml version=""1.0"" encoding=""UTF-8"" ?><event version=""2.0"" uid=""%1"" type=""b-m-p-w"" time=""%2"" start=""%2"" stale=""%3"" how=""h-e""><point lat=""%4"" lon=""%5"" hae=""%6"" ce=""9999999.0"" le=""9999999.0""/><detail><contact callsign=""%7""/><remarks/><archive/><link relation=""p-p"" type=""b-m-r"" uid=""%8""/></detail></event>",
|
||||||
|
_waypointUid,
|
||||||
|
_now,
|
||||||
|
_stale,
|
||||||
|
_pointParts select 0,
|
||||||
|
_pointParts select 1,
|
||||||
|
_pointParts select 2,
|
||||||
|
_waypointCallsign,
|
||||||
|
_uuid
|
||||||
|
];
|
||||||
|
"armatak" callExtension ["tcp_socket:send_payload", [_waypointXml]];
|
||||||
|
[_scope, _waypointUid, "b-m-p-w", parseNumber (_pointParts select 0), parseNumber (_pointParts select 1), parseNumber (_pointParts select 2)] call armatak_fnc_register_cot;
|
||||||
|
};
|
||||||
|
} forEach _routeWaypoints;
|
||||||
|
|
||||||
|
_uuid
|
||||||
@@ -0,0 +1,75 @@
|
|||||||
|
// function name: armatak_fnc_draw_tactical_graphic
|
||||||
|
// function author: Valmo
|
||||||
|
// function description: Sends an ATAK Drawing Tools shape with a MilSym tactical graphic overlay.
|
||||||
|
//
|
||||||
|
// Arguments:
|
||||||
|
// 0: Positions or objects <ARRAY>
|
||||||
|
// 1: MilSym SIDC <STRING>
|
||||||
|
// 2: Callsign/title <STRING> (default: "ArmaTAK Tactical Graphic")
|
||||||
|
// 3: Closed polygon <BOOL> (default: false)
|
||||||
|
// 4: Stale time in seconds <NUMBER> (default: 86400)
|
||||||
|
// 5: Stroke color as signed ARGB int <NUMBER> (default: -1)
|
||||||
|
// 6: Fill color as signed ARGB int <NUMBER> (default: -1761607681)
|
||||||
|
// 7: Stroke weight <NUMBER> (default: 3)
|
||||||
|
//
|
||||||
|
// Example:
|
||||||
|
// [[pos player, screenToWorld [0.5, 0.5]], "GFGPOLAGM-----X", "Axis of Advance"] call armatak_fnc_draw_tactical_graphic;
|
||||||
|
//
|
||||||
|
// Public: Yes
|
||||||
|
|
||||||
|
params [
|
||||||
|
["_points", [], [[]]],
|
||||||
|
["_milsym", "", [""]],
|
||||||
|
["_callsign", "ArmaTAK Tactical Graphic", [""]],
|
||||||
|
["_closed", false, [true]],
|
||||||
|
["_staleSeconds", 86400, [0]],
|
||||||
|
["_strokeColor", -1, [0]],
|
||||||
|
["_fillColor", -1761607681, [0]],
|
||||||
|
["_strokeWeight", 3, [0]]
|
||||||
|
];
|
||||||
|
|
||||||
|
if (_milsym isEqualTo "") exitWith {""};
|
||||||
|
if ((count _points) < 2) exitWith {""};
|
||||||
|
|
||||||
|
private _pointStrings = [];
|
||||||
|
private _center = [];
|
||||||
|
|
||||||
|
{
|
||||||
|
private _position = if (_x isEqualType objNull) then {
|
||||||
|
getPos _x
|
||||||
|
} else {
|
||||||
|
_x
|
||||||
|
};
|
||||||
|
|
||||||
|
if ((count _position) >= 2) then {
|
||||||
|
private _altitude = _position param [2, 0, [0]];
|
||||||
|
private _realLocation = [_position select 0, _position select 1, _altitude] call armatak_client_fnc_convertClientLocation;
|
||||||
|
_pointStrings pushBack format ["%1,%2,%3", _realLocation select 0, _realLocation select 1, _realLocation select 2];
|
||||||
|
|
||||||
|
if (_center isEqualTo []) then {
|
||||||
|
_center = _realLocation;
|
||||||
|
};
|
||||||
|
};
|
||||||
|
} forEach _points;
|
||||||
|
|
||||||
|
if ((count _pointStrings) < 2) exitWith {""};
|
||||||
|
|
||||||
|
private _uuid = "armatak" callExtension ["uuid", []] select 0;
|
||||||
|
private _payload = [
|
||||||
|
_uuid,
|
||||||
|
"u-d-f",
|
||||||
|
_center select 0,
|
||||||
|
_center select 1,
|
||||||
|
_center select 2,
|
||||||
|
_pointStrings joinString ";",
|
||||||
|
_callsign,
|
||||||
|
_staleSeconds max 1,
|
||||||
|
_strokeColor,
|
||||||
|
_fillColor,
|
||||||
|
_strokeWeight max 1,
|
||||||
|
"solid",
|
||||||
|
_closed,
|
||||||
|
_milsym
|
||||||
|
];
|
||||||
|
|
||||||
|
"armatak" callExtension ["tcp_socket:draw:vector", [_payload]];
|
||||||
@@ -0,0 +1,30 @@
|
|||||||
|
// function name: armatak_fnc_register_cot
|
||||||
|
// function author: Valmo, Codex
|
||||||
|
// function description: Registers a CoT object under a scope so it can be deleted later.
|
||||||
|
//
|
||||||
|
// Arguments:
|
||||||
|
// 0: Scope/key used to group CoTs <STRING>
|
||||||
|
// 1: CoT UID <STRING>
|
||||||
|
// 2: CoT type <STRING>
|
||||||
|
// 3: Latitude <NUMBER>
|
||||||
|
// 4: Longitude <NUMBER>
|
||||||
|
// 5: HAE altitude <NUMBER>
|
||||||
|
//
|
||||||
|
// Public: Yes
|
||||||
|
|
||||||
|
params [
|
||||||
|
["_scope", "", [""]],
|
||||||
|
["_uid", "", [""]],
|
||||||
|
["_type", "", [""]],
|
||||||
|
["_lat", 0, [0]],
|
||||||
|
["_lon", 0, [0]],
|
||||||
|
["_hae", 0, [0]]
|
||||||
|
];
|
||||||
|
|
||||||
|
if (_scope isEqualTo "" || {_uid isEqualTo ""} || {_type isEqualTo ""}) exitWith {false};
|
||||||
|
|
||||||
|
private _registry = missionNamespace getVariable ["armatak_registered_cots", []];
|
||||||
|
_registry pushBack [_scope, _uid, _type, _lat, _lon, _hae];
|
||||||
|
missionNamespace setVariable ["armatak_registered_cots", _registry];
|
||||||
|
|
||||||
|
true
|
||||||
@@ -0,0 +1,105 @@
|
|||||||
|
// function name: armatak_fnc_report_marker
|
||||||
|
// function author: Valmo
|
||||||
|
// function description: Sends a one-shot TAK report marker with an independent stale time.
|
||||||
|
//
|
||||||
|
// Arguments:
|
||||||
|
// 0: Source position or object <ARRAY|OBJECT>
|
||||||
|
// 1: Affiliation or raw CoT type <STRING> (default: "unknown")
|
||||||
|
// Supported affiliations: "friendly", "enemy", "hostile", "neutral", "unknown"
|
||||||
|
// 2: Marker kind <STRING> (default: "infantry")
|
||||||
|
// Supported kinds: "infantry", "tank", "car", "apc", "helicopter", "plane", "ship", "static"
|
||||||
|
// 3: Callsign <STRING> (default: "Report")
|
||||||
|
// 4: Remarks <STRING> (default: "")
|
||||||
|
// 5: Stale time in seconds <NUMBER> (default: 3600)
|
||||||
|
// 6: Optional registration scope <STRING> (default: "")
|
||||||
|
//
|
||||||
|
// Example:
|
||||||
|
// [cursorObject, "enemy", "tank", "Enemy Tank", "Reported enemy tank"] call armatak_fnc_report_marker;
|
||||||
|
// [screenToWorld [0.5, 0.5], "unknown", "infantry", "Unknown Contact", "Unknown contact reported", 7200] call armatak_fnc_report_marker;
|
||||||
|
// [cursorObject, "a-h-G-U-C-A-T", "Enemy Tank", "Reported enemy tank", 7200] call armatak_fnc_report_marker;
|
||||||
|
//
|
||||||
|
// Public: Yes
|
||||||
|
|
||||||
|
params [
|
||||||
|
["_source", objNull, [objNull, []]],
|
||||||
|
["_affiliationOrType", "unknown", [""]],
|
||||||
|
["_kindOrCallsign", "infantry", [""]],
|
||||||
|
["_callsignOrRemarks", "Report", [""]],
|
||||||
|
["_remarksOrStaleSeconds", "", ["", 0]],
|
||||||
|
["_staleSeconds", 3600, [0, ""]],
|
||||||
|
["_scope", "", [""]]
|
||||||
|
];
|
||||||
|
|
||||||
|
private _type = "";
|
||||||
|
private _callsign = _callsignOrRemarks;
|
||||||
|
private _remarks = _remarksOrStaleSeconds;
|
||||||
|
|
||||||
|
if (_staleSeconds isEqualType "") then {
|
||||||
|
_scope = _staleSeconds;
|
||||||
|
_staleSeconds = 3600;
|
||||||
|
};
|
||||||
|
|
||||||
|
if ((_affiliationOrType select [0, 2]) isEqualTo "a-") then {
|
||||||
|
_type = _affiliationOrType;
|
||||||
|
_callsign = _kindOrCallsign;
|
||||||
|
_remarks = _callsignOrRemarks;
|
||||||
|
|
||||||
|
if (_remarksOrStaleSeconds isEqualType 0) then {
|
||||||
|
_staleSeconds = _remarksOrStaleSeconds;
|
||||||
|
};
|
||||||
|
} else {
|
||||||
|
private _affiliation = switch (toLower _affiliationOrType) do {
|
||||||
|
case "friendly": {"f"};
|
||||||
|
case "enemy": {"h"};
|
||||||
|
case "hostile": {"h"};
|
||||||
|
case "neutral": {"n"};
|
||||||
|
default {"u"};
|
||||||
|
};
|
||||||
|
|
||||||
|
private _kind = switch (toLower _kindOrCallsign) do {
|
||||||
|
case "tank": {"G-U-C-A-T"};
|
||||||
|
case "car": {"G-U-C-I-M"};
|
||||||
|
case "apc": {"G-U-C-I-I"};
|
||||||
|
case "helicopter": {"A-M-H"};
|
||||||
|
case "plane": {"A-M-F"};
|
||||||
|
case "ship": {"S"};
|
||||||
|
case "static": {"G-U-C-F-M"};
|
||||||
|
default {"G-U-C-I"};
|
||||||
|
};
|
||||||
|
|
||||||
|
_type = "a-" + _affiliation + "-" + _kind;
|
||||||
|
|
||||||
|
if (_remarksOrStaleSeconds isEqualType 0) then {
|
||||||
|
_staleSeconds = _remarksOrStaleSeconds;
|
||||||
|
_remarks = "";
|
||||||
|
};
|
||||||
|
};
|
||||||
|
|
||||||
|
private _position = if (_source isEqualType objNull) then {
|
||||||
|
getPos _source
|
||||||
|
} else {
|
||||||
|
_source
|
||||||
|
};
|
||||||
|
|
||||||
|
if ((count _position) < 2) exitWith {
|
||||||
|
""
|
||||||
|
};
|
||||||
|
|
||||||
|
private _altitude = _position param [2, 0, [0]];
|
||||||
|
private _realLocation = [_position select 0, _position select 1, _altitude] call armatak_client_fnc_convertClientLocation;
|
||||||
|
private _uuid = "armatak" callExtension ["uuid", []] select 0;
|
||||||
|
private _payload = [
|
||||||
|
_uuid,
|
||||||
|
_type,
|
||||||
|
_realLocation select 0,
|
||||||
|
_realLocation select 1,
|
||||||
|
_realLocation select 2,
|
||||||
|
_callsign,
|
||||||
|
_staleSeconds max 1,
|
||||||
|
_remarks
|
||||||
|
];
|
||||||
|
|
||||||
|
"armatak" callExtension ["tcp_socket:cot:report_marker", [_payload]];
|
||||||
|
[_scope, _uuid, _type, _realLocation select 0, _realLocation select 1, _realLocation select 2] call armatak_fnc_register_cot;
|
||||||
|
|
||||||
|
_uuid
|
||||||
@@ -6,7 +6,13 @@ if (!isNull _digitalPointer) then {
|
|||||||
_digitalPointerPosition = _digitalPointer call armatak_client_fnc_extractClientPosition;
|
_digitalPointerPosition = _digitalPointer call armatak_client_fnc_extractClientPosition;
|
||||||
|
|
||||||
_link_uid = [_unit] call armatak_fnc_extract_uuid;
|
_link_uid = [_unit] call armatak_fnc_extract_uuid;
|
||||||
_contact_callsign = ([player] call armatak_fnc_extract_unit_callsign) + ".DP1";
|
_objectType = [_unit] call BIS_fnc_objectType;
|
||||||
|
_ownerCallsign = if ((_objectType select 0) == "Soldier") then {
|
||||||
|
[_unit] call armatak_fnc_extract_unit_callsign
|
||||||
|
} else {
|
||||||
|
[_unit] call armatak_fnc_extract_marker_callsign
|
||||||
|
};
|
||||||
|
_contact_callsign = _ownerCallsign + ".DP1";
|
||||||
|
|
||||||
_dpCot = [_link_uid, _contact_callsign, _digitalPointerPosition select 1, _digitalPointerPosition select 2, _digitalPointerPosition select 3];
|
_dpCot = [_link_uid, _contact_callsign, _digitalPointerPosition select 1, _digitalPointerPosition select 2, _digitalPointerPosition select 3];
|
||||||
|
|
||||||
|
|||||||
@@ -4,31 +4,4 @@
|
|||||||
|
|
||||||
params["_drone"];
|
params["_drone"];
|
||||||
|
|
||||||
private _atak_role = "a-f-A";
|
[_drone] call armatak_fnc_send_uas_platform_cot;
|
||||||
private _atak_callsign = [_drone] call armatak_fnc_extract_marker_callsign;
|
|
||||||
|
|
||||||
switch (side _drone) do {
|
|
||||||
case "WEST": {
|
|
||||||
_atak_role = "a-f-A-M-F-Q"
|
|
||||||
};
|
|
||||||
case "EAST": {
|
|
||||||
_atak_role = "a-h-A-M-F-Q"
|
|
||||||
};
|
|
||||||
case "INDEPENDENT": {
|
|
||||||
_atak_role = "a-n-A-M-F-Q"
|
|
||||||
};
|
|
||||||
case "CIVILIAN": {
|
|
||||||
_atak_role = "a-f-A-C"
|
|
||||||
};
|
|
||||||
default {
|
|
||||||
_atak_role = "a-f-A-M-F-Q"
|
|
||||||
};
|
|
||||||
};
|
|
||||||
|
|
||||||
_pre_defined_role = _drone getVariable "_atak_group_role";
|
|
||||||
|
|
||||||
if (!isNil "_pre_defined_role") then {
|
|
||||||
_callsign = _pre_defined_role;
|
|
||||||
};
|
|
||||||
|
|
||||||
_cot = [_drone, _atak_role, _atak_callsign] call armatak_fnc_send_marker_cot;
|
|
||||||
|
|||||||
@@ -5,9 +5,10 @@
|
|||||||
params ["_unit", "_type", "_callsign"];
|
params ["_unit", "_type", "_callsign"];
|
||||||
|
|
||||||
_unit_position = _unit call armatak_client_fnc_extractClientPosition;
|
_unit_position = _unit call armatak_client_fnc_extractClientPosition;
|
||||||
|
_video_url = [_unit] call armatak_fnc_extract_marker_video_url;
|
||||||
|
|
||||||
_uuid = _unit call armatak_fnc_extract_uuid;
|
_uuid = _unit call armatak_fnc_extract_uuid;
|
||||||
|
|
||||||
_marker_cot = [_uuid, _type, _unit_position select 1, _unit_position select 2, _unit_position select 3, _callsign, _unit_position select 5, _unit_position select 6];
|
_marker_cot = [_uuid, _type, _unit_position select 1, _unit_position select 2, _unit_position select 3, _callsign, _unit_position select 5, _unit_position select 6, _video_url];
|
||||||
|
|
||||||
"armatak" callExtension ["tcp_socket:cot:marker", [_marker_cot]];
|
"armatak" callExtension ["tcp_socket:cot:marker", [_marker_cot]];
|
||||||
|
|||||||
@@ -0,0 +1,77 @@
|
|||||||
|
params ["_drone"];
|
||||||
|
|
||||||
|
private _uuid = _drone call armatak_fnc_extract_uuid;
|
||||||
|
private _uavControl = UAVControl _drone;
|
||||||
|
private _controller = _uavControl param [0, objNull];
|
||||||
|
private _controller_uid = if (!isNull _controller) then { [_controller] call armatak_fnc_extract_uuid } else { _drone getVariable ["armatak_uas_controller_uid", _uuid] };
|
||||||
|
private _callsign = [_drone] call armatak_fnc_extract_marker_callsign;
|
||||||
|
private _video_url = [_drone] call armatak_fnc_extract_marker_video_url;
|
||||||
|
|
||||||
|
private _atak_role = "a-f-A-M-H-Q";
|
||||||
|
switch (side _drone) do {
|
||||||
|
case west: {
|
||||||
|
_atak_role = "a-f-A-M-H-Q";
|
||||||
|
};
|
||||||
|
case east: {
|
||||||
|
_atak_role = "a-h-A-M-H-Q";
|
||||||
|
};
|
||||||
|
case independent: {
|
||||||
|
_atak_role = "a-n-A-M-H-Q";
|
||||||
|
};
|
||||||
|
case civilian: {
|
||||||
|
_atak_role = "a-f-A-C";
|
||||||
|
};
|
||||||
|
default {
|
||||||
|
_atak_role = "a-f-A-M-H-Q";
|
||||||
|
};
|
||||||
|
};
|
||||||
|
|
||||||
|
private _position = _drone call armatak_client_fnc_extractClientPosition;
|
||||||
|
private _lat = _position select 1;
|
||||||
|
private _lon = _position select 2;
|
||||||
|
private _hae = _position select 3;
|
||||||
|
private _course = _position select 5;
|
||||||
|
private _speed = _position select 6;
|
||||||
|
|
||||||
|
private _cameraData = [_drone] call armatak_fnc_extract_uas_camera_data;
|
||||||
|
private _azimuth = _cameraData select 0;
|
||||||
|
private _elevation = _cameraData select 1;
|
||||||
|
private _fov = _cameraData select 2;
|
||||||
|
private _range = _cameraData select 3;
|
||||||
|
private _vfov = _drone getVariable ["armatak_uas_vfov", _fov];
|
||||||
|
|
||||||
|
private _yaw = round (getDir _drone);
|
||||||
|
private _pitch = (vectorDir _drone) select 2;
|
||||||
|
private _roll = (vectorUp _drone) select 0;
|
||||||
|
private _isFlying = parseNumber (isEngineOn _drone);
|
||||||
|
private _hal = ((getPosATL _drone) select 2) max 0;
|
||||||
|
private _vehicleType = if (_video_url == "") then {
|
||||||
|
typeOf _drone
|
||||||
|
} else {
|
||||||
|
format ["%1|armatak_video_url=%2", typeOf _drone, _video_url]
|
||||||
|
};
|
||||||
|
|
||||||
|
private _payload = [
|
||||||
|
_uuid,
|
||||||
|
_atak_role,
|
||||||
|
_callsign,
|
||||||
|
_lat,
|
||||||
|
_lon,
|
||||||
|
_hae,
|
||||||
|
_course,
|
||||||
|
_speed,
|
||||||
|
_azimuth,
|
||||||
|
_elevation,
|
||||||
|
_fov,
|
||||||
|
_vfov,
|
||||||
|
_range,
|
||||||
|
_yaw,
|
||||||
|
_pitch,
|
||||||
|
_roll,
|
||||||
|
_hal,
|
||||||
|
_vehicleType,
|
||||||
|
_isFlying,
|
||||||
|
_controller_uid
|
||||||
|
];
|
||||||
|
|
||||||
|
"armatak" callExtension ["tcp_socket:cot:uas_platform", [_payload]];
|
||||||
@@ -0,0 +1,22 @@
|
|||||||
|
params ["_drone"];
|
||||||
|
|
||||||
|
private _video_url = [_drone] call armatak_fnc_extract_marker_video_url;
|
||||||
|
if (_video_url == "") exitWith {};
|
||||||
|
|
||||||
|
private _uuid = _drone call armatak_fnc_extract_uuid;
|
||||||
|
private _video_uid = _uuid + "-video";
|
||||||
|
private _sensor_uid = _uuid + "-sensor";
|
||||||
|
private _callsign = [_drone] call armatak_fnc_extract_marker_callsign;
|
||||||
|
|
||||||
|
private _position = _drone call armatak_client_fnc_extractClientPosition;
|
||||||
|
private _lat = _position select 1;
|
||||||
|
private _lon = _position select 2;
|
||||||
|
private _hae = _position select 3;
|
||||||
|
|
||||||
|
private _cameraData = [_drone] call armatak_fnc_extract_uas_camera_data;
|
||||||
|
private _azimuth = _cameraData select 0;
|
||||||
|
private _fov = _cameraData select 2;
|
||||||
|
private _range = _cameraData select 3;
|
||||||
|
|
||||||
|
private _payload = [_sensor_uid, _video_uid, _callsign, _lat, _lon, _hae, _azimuth, _fov, _range];
|
||||||
|
"armatak" callExtension ["tcp_socket:cot:uas_sensor", [_payload]];
|
||||||
@@ -0,0 +1,20 @@
|
|||||||
|
params ["_drone"];
|
||||||
|
|
||||||
|
private _video_url = [_drone] call armatak_fnc_extract_marker_video_url;
|
||||||
|
if (_video_url == "") exitWith {};
|
||||||
|
|
||||||
|
private _uuid = _drone call armatak_fnc_extract_uuid;
|
||||||
|
private _video_uid = _uuid + "-video";
|
||||||
|
private _callsign = [_drone] call armatak_fnc_extract_marker_callsign;
|
||||||
|
|
||||||
|
private _signature = format ["%1|%2|%3", _video_uid, _callsign, _video_url];
|
||||||
|
private _nextRefreshAt = _drone getVariable ["armatak_next_uas_video_refresh_at", 0];
|
||||||
|
private _lastSignature = _drone getVariable ["armatak_last_uas_video_signature", ""];
|
||||||
|
|
||||||
|
if (_signature == _lastSignature && {diag_tickTime < _nextRefreshAt}) exitWith {};
|
||||||
|
|
||||||
|
_drone setVariable ["armatak_last_uas_video_signature", _signature, false];
|
||||||
|
_drone setVariable ["armatak_next_uas_video_refresh_at", diag_tickTime + 300, false];
|
||||||
|
|
||||||
|
private _payload = [_video_uid, _callsign, _video_url];
|
||||||
|
"armatak" callExtension ["tcp_socket:cot:uas_video", [_payload]];
|
||||||
@@ -0,0 +1,9 @@
|
|||||||
|
params ["_drone", ["_cameraData", []]];
|
||||||
|
|
||||||
|
if (isNull _drone) exitWith {};
|
||||||
|
|
||||||
|
if ((_cameraData isEqualType []) && {(count _cameraData) >= 6}) then {
|
||||||
|
_drone setVariable ["armatak_uas_camera_data_override", _cameraData + [serverTime], false];
|
||||||
|
} else {
|
||||||
|
_drone setVariable ["armatak_uas_camera_data_override", nil, false];
|
||||||
|
};
|
||||||
@@ -5,29 +5,45 @@
|
|||||||
params["_unit"];
|
params["_unit"];
|
||||||
|
|
||||||
private _callsign = "";
|
private _callsign = "";
|
||||||
|
private _displayName = localize (getText (configOf _unit >> "displayName"));
|
||||||
|
private _markerCallsignOverride = _unit getVariable ["armatak_attribute_marker_callsign", ""];
|
||||||
|
|
||||||
|
if (_markerCallsignOverride isNotEqualTo "") exitWith {
|
||||||
|
_markerCallsignOverride
|
||||||
|
};
|
||||||
|
|
||||||
|
if (_displayName isEqualTo "") then {
|
||||||
|
_displayName = typeOf _unit;
|
||||||
|
};
|
||||||
|
|
||||||
|
private _vehicleName = vehicleVarName _unit;
|
||||||
|
|
||||||
if ((([_unit] call BIS_fnc_objectType) select 0) == "Vehicle") then {
|
if ((([_unit] call BIS_fnc_objectType) select 0) == "Vehicle") then {
|
||||||
_callsign = getText (configOf _unit >> "displayName");
|
_callsign = [_displayName, _vehicleName] select (_vehicleName isNotEqualTo "");
|
||||||
|
|
||||||
if (!isNull driver _unit) then {
|
if (!isNull driver _unit) then {
|
||||||
_callsign = getText (configOf _unit >> "displayName") + " | " + ([name (driver _unit)] call armatak_fnc_shorten_name);
|
_callsign = _displayName + " | " + ([name (driver _unit)] call armatak_fnc_shorten_name);
|
||||||
};
|
};
|
||||||
};
|
};
|
||||||
|
|
||||||
if (unitIsUAV _unit) then {
|
if (unitIsUAV _unit) then {
|
||||||
_callsign = getText (configOf _unit >> "displayName");
|
_callsign = [_displayName, _vehicleName] select (_vehicleName isNotEqualTo "");
|
||||||
|
|
||||||
|
private _uavControl = UAVControl _unit;
|
||||||
|
private _controller = _uavControl param [0, objNull];
|
||||||
|
if (!isNull _controller) then {
|
||||||
|
_callsign = _callsign + " | " + ([name _controller] call armatak_fnc_shorten_name);
|
||||||
|
};
|
||||||
|
|
||||||
if (isUAVConnected _unit) then {
|
if (isUAVConnected _unit) then {
|
||||||
_callsign = (_callsign) + "[ON]";
|
_callsign = _callsign + " [ON]";
|
||||||
} else {
|
} else {
|
||||||
_callsign = (_callsign) + "[OFF]";
|
_callsign = _callsign + " [OFF]";
|
||||||
}
|
}
|
||||||
};
|
};
|
||||||
|
|
||||||
armatak_attribute_marker_callsign = _unit getVariable "armatak_attribute_marker_callsign";
|
if (_callsign isEqualTo "") then {
|
||||||
|
_callsign = _displayName;
|
||||||
if (!isNil "armatak_attribute_marker_callsign" or armatak_attribute_marker_callsign != '') then {
|
|
||||||
_callsign = armatak_attribute_marker_callsign;
|
|
||||||
};
|
};
|
||||||
|
|
||||||
_callsign
|
_callsign
|
||||||
|
|||||||
@@ -0,0 +1,13 @@
|
|||||||
|
// function name: armatak_fnc_extract_marker_video_url
|
||||||
|
// function author: Codex
|
||||||
|
// function description: Gets the marker video URL configured in 3DEN for a vehicle
|
||||||
|
|
||||||
|
params ["_unit"];
|
||||||
|
|
||||||
|
private _videoUrl = _unit getVariable ["armatak_attribute_marker_video_url", ""];
|
||||||
|
|
||||||
|
if (isNil "_videoUrl") exitWith {
|
||||||
|
""
|
||||||
|
};
|
||||||
|
|
||||||
|
_videoUrl
|
||||||
@@ -7,13 +7,7 @@ params["_unit"];
|
|||||||
private _affiliation = "f";
|
private _affiliation = "f";
|
||||||
private _type = "G";
|
private _type = "G";
|
||||||
private _role = "a-f-G-U-C-I";
|
private _role = "a-f-G-U-C-I";
|
||||||
private _side = side _unit;
|
private _side = _unit getVariable ["armatak_current_side", side _unit];
|
||||||
|
|
||||||
if (isNil {
|
|
||||||
_unit getVariable "armatak_current_side"
|
|
||||||
}) then {
|
|
||||||
_side = _unit getVariable "armatak_current_side";
|
|
||||||
};
|
|
||||||
|
|
||||||
switch (str _side) do {
|
switch (str _side) do {
|
||||||
case "WEST": {
|
case "WEST": {
|
||||||
@@ -33,7 +27,7 @@ switch (str _side) do {
|
|||||||
};
|
};
|
||||||
};
|
};
|
||||||
|
|
||||||
_unit_type = _unit call BIS_fnc_objectType;
|
private _unit_type = _unit call BIS_fnc_objectType;
|
||||||
|
|
||||||
if ((_unit_type select 0) == "Soldier") then {
|
if ((_unit_type select 0) == "Soldier") then {
|
||||||
switch (_unit_type select 1) do {
|
switch (_unit_type select 1) do {
|
||||||
@@ -77,7 +71,7 @@ if ((_unit_type select 0) == "Soldier") then {
|
|||||||
};
|
};
|
||||||
|
|
||||||
if ((typeOf (vehicle _unit) != typeOf _unit) or ((_unit_type select 0) == "Vehicle")) then {
|
if ((typeOf (vehicle _unit) != typeOf _unit) or ((_unit_type select 0) == "Vehicle")) then {
|
||||||
_vehicle_type = (vehicle _unit) call BIS_fnc_objectType select 1;
|
private _vehicle_type = (vehicle _unit) call BIS_fnc_objectType select 1;
|
||||||
switch (_vehicle_type) do {
|
switch (_vehicle_type) do {
|
||||||
case "Car": {
|
case "Car": {
|
||||||
_type = "G-U-C-I-M";
|
_type = "G-U-C-I-M";
|
||||||
@@ -117,10 +111,10 @@ if ((typeOf (vehicle _unit) != typeOf _unit) or ((_unit_type select 0) == "Vehic
|
|||||||
|
|
||||||
_role = "a-" + _affiliation + "-" + _type;
|
_role = "a-" + _affiliation + "-" + _type;
|
||||||
|
|
||||||
armatak_attribute_marker_type = _unit getVariable "armatak_attribute_marker_type";
|
private _markerTypeOverride = _unit getVariable ["armatak_attribute_marker_type", ""];
|
||||||
|
|
||||||
if (!isNil "armatak_attribute_marker_type" or armatak_attribute_marker_type != '') then {
|
if (_markerTypeOverride isNotEqualTo "") then {
|
||||||
_role = armatak_attribute_marker_type;
|
_role = _markerTypeOverride;
|
||||||
};
|
};
|
||||||
|
|
||||||
_role
|
_role
|
||||||
|
|||||||
@@ -1,27 +1,32 @@
|
|||||||
params["_unit"];
|
params["_unit"];
|
||||||
|
|
||||||
|
if (_unit getVariable ["armatak_disable_sensor_data", false]) exitWith {};
|
||||||
|
|
||||||
_target = getSensorTargets (_unit);
|
_target = getSensorTargets (_unit);
|
||||||
|
|
||||||
{
|
{
|
||||||
_unit = _x select 0;
|
private _targetUnit = _x select 0;
|
||||||
_position = _x select 1;
|
_position = _x select 1;
|
||||||
_status = _x select 2;
|
_status = _x select 2;
|
||||||
|
private _targetType = toLower (typeOf _targetUnit);
|
||||||
|
|
||||||
if (isNil {
|
if ((_targetType find "lasertarget") < 0) then {
|
||||||
_unit getVariable "armatak_current_side"
|
if (isNil {
|
||||||
}) then {
|
_targetUnit getVariable "armatak_current_side"
|
||||||
_unit setVariable ["armatak_current_side", side _unit];
|
}) then {
|
||||||
};
|
_targetUnit setVariable ["armatak_current_side", side _targetUnit];
|
||||||
|
};
|
||||||
|
|
||||||
if (_status != "destroyed" && !(_unit in armatak_server_syncedUnits)) then {
|
if (_status != "destroyed" && !(_targetUnit in armatak_server_syncedUnits)) then {
|
||||||
_unit_position = _unit call armatak_client_fnc_extractClientPosition;
|
_unit_position = _targetUnit call armatak_client_fnc_extractClientPosition;
|
||||||
|
|
||||||
_uuid = _unit call armatak_fnc_extract_uuid;
|
_uuid = _targetUnit call armatak_fnc_extract_uuid;
|
||||||
_type = _unit call armatak_fnc_extract_role;
|
_type = _targetUnit call armatak_fnc_extract_role;
|
||||||
_callsign = getText (configOf _unit >> "displayName");
|
_callsign = getText (configOf _targetUnit >> "displayName");
|
||||||
|
|
||||||
_marker_cot = [_uuid, _type, _unit_position select 1, _unit_position select 2, _unit_position select 3, _callsign, _unit_position select 5, _unit_position select 6];
|
_marker_cot = [_uuid, _type, _unit_position select 1, _unit_position select 2, _unit_position select 3, _callsign, _unit_position select 5, _unit_position select 6];
|
||||||
|
|
||||||
"armatak" callExtension ["tcp_socket:cot:marker", [_marker_cot]];
|
"armatak" callExtension ["tcp_socket:cot:marker", [_marker_cot]];
|
||||||
|
};
|
||||||
};
|
};
|
||||||
} forEach _target;
|
} forEach _target;
|
||||||
|
|||||||
@@ -0,0 +1,143 @@
|
|||||||
|
params ["_drone", ["_cameraMode", "turret"]];
|
||||||
|
|
||||||
|
private _override = _drone getVariable ["armatak_uas_camera_data_override", []];
|
||||||
|
private _isLocalController = hasInterface && {!isNull player} && {(getConnectedUAV player) isEqualTo _drone};
|
||||||
|
|
||||||
|
if (!_isLocalController && {_override isEqualType []} && {(count _override) >= 7}) then {
|
||||||
|
private _updatedAt = _override param [6, -1000];
|
||||||
|
if ((time - _updatedAt) <= 5) exitWith {
|
||||||
|
private _overrideSpiAsl = _override param [4, []];
|
||||||
|
private _overrideSpiGeo = _override param [5, []];
|
||||||
|
_drone setVariable ["armatak_uas_spi_asl", _overrideSpiAsl, false];
|
||||||
|
_drone setVariable ["armatak_uas_spi_geo", _overrideSpiGeo, false];
|
||||||
|
_override select [0, 6]
|
||||||
|
};
|
||||||
|
};
|
||||||
|
|
||||||
|
private _defaultFov = _drone getVariable ["armatak_uas_fov", 60];
|
||||||
|
private _maxRange = _drone getVariable ["armatak_uas_max_range", 15000];
|
||||||
|
private _originASL = getPosASL _drone;
|
||||||
|
private _originAGL = ASLToAGL _originASL;
|
||||||
|
private _cameraDir = [];
|
||||||
|
private _spiASL = [];
|
||||||
|
private _slantRange = 0;
|
||||||
|
|
||||||
|
if (_cameraMode isNotEqualTo "fpv") then {
|
||||||
|
private _laserTarget = laserTarget _drone;
|
||||||
|
if (!isNull _laserTarget) then {
|
||||||
|
private _laserTargetWorld = getPosWorld _laserTarget;
|
||||||
|
private _laserTargetAslZ = (getPosASL _laserTarget) select 2;
|
||||||
|
_spiASL = [_laserTargetWorld select 0, _laserTargetWorld select 1, _laserTargetAslZ];
|
||||||
|
_cameraDir = _spiASL vectorDiff _originASL;
|
||||||
|
_slantRange = _originASL vectorDistance _spiASL;
|
||||||
|
};
|
||||||
|
};
|
||||||
|
|
||||||
|
if (_cameraDir isEqualTo [] && {_cameraMode isNotEqualTo "fpv"}) then {
|
||||||
|
private _uavControl = UAVControl _drone;
|
||||||
|
private _controlledTurretPath = _uavControl param [1, []];
|
||||||
|
private _candidateTurrets = [];
|
||||||
|
|
||||||
|
if ((_controlledTurretPath isEqualType []) && {_controlledTurretPath isNotEqualTo []}) then {
|
||||||
|
_candidateTurrets pushBack _controlledTurretPath;
|
||||||
|
};
|
||||||
|
|
||||||
|
{
|
||||||
|
if !(_x in _candidateTurrets) then {
|
||||||
|
_candidateTurrets pushBack _x;
|
||||||
|
};
|
||||||
|
} forEach (allTurrets _drone);
|
||||||
|
|
||||||
|
{
|
||||||
|
private _turretWeapons = _drone weaponsTurret _x;
|
||||||
|
if (_turretWeapons isNotEqualTo []) exitWith {
|
||||||
|
private _weapon = _turretWeapons select 0;
|
||||||
|
private _weaponDirection = _drone weaponDirection _weapon;
|
||||||
|
if (_weaponDirection isNotEqualTo [0, 0, 0]) then {
|
||||||
|
_cameraDir = _weaponDirection;
|
||||||
|
};
|
||||||
|
};
|
||||||
|
} forEach _candidateTurrets;
|
||||||
|
};
|
||||||
|
|
||||||
|
if (_cameraDir isEqualTo []) then {
|
||||||
|
_cameraDir = vectorDirVisual _drone;
|
||||||
|
};
|
||||||
|
|
||||||
|
private _dirMagnitude = vectorMagnitude _cameraDir;
|
||||||
|
if (_dirMagnitude <= 0) then {
|
||||||
|
private _fallbackAzimuth = getDir _drone;
|
||||||
|
_cameraDir = [sin _fallbackAzimuth, cos _fallbackAzimuth, -1];
|
||||||
|
_dirMagnitude = vectorMagnitude _cameraDir;
|
||||||
|
};
|
||||||
|
|
||||||
|
_cameraDir = _cameraDir vectorMultiply (1 / _dirMagnitude);
|
||||||
|
|
||||||
|
private _dirX = _cameraDir select 0;
|
||||||
|
private _dirY = _cameraDir select 1;
|
||||||
|
private _dirZ = _cameraDir select 2;
|
||||||
|
private _horizontalMagnitude = sqrt ((_dirX * _dirX) + (_dirY * _dirY));
|
||||||
|
|
||||||
|
private _azimuth = (((_dirX atan2 _dirY) + 360) mod 360);
|
||||||
|
private _elevation = (_dirZ atan2 (_horizontalMagnitude max 0.001));
|
||||||
|
|
||||||
|
if (_spiASL isEqualTo []) then {
|
||||||
|
private _altitudeAGL = (_originAGL select 2) max 0.1;
|
||||||
|
private _probeASL = _originASL vectorAdd (_cameraDir vectorMultiply _maxRange);
|
||||||
|
|
||||||
|
if (_dirZ < -0.01 && {terrainIntersectASL [_originASL, _probeASL]}) then {
|
||||||
|
private _near = _originASL;
|
||||||
|
private _far = _probeASL;
|
||||||
|
|
||||||
|
for "_i" from 0 to 24 do {
|
||||||
|
private _mid = [
|
||||||
|
((_near select 0) + (_far select 0)) / 2,
|
||||||
|
((_near select 1) + (_far select 1)) / 2,
|
||||||
|
((_near select 2) + (_far select 2)) / 2
|
||||||
|
];
|
||||||
|
|
||||||
|
if (terrainIntersectASL [_originASL, _mid]) then {
|
||||||
|
_far = _mid;
|
||||||
|
} else {
|
||||||
|
_near = _mid;
|
||||||
|
};
|
||||||
|
};
|
||||||
|
|
||||||
|
_spiASL = _far;
|
||||||
|
_slantRange = _originASL vectorDistance _spiASL;
|
||||||
|
} else {
|
||||||
|
private _verticalComponent = abs _dirZ;
|
||||||
|
|
||||||
|
if (_verticalComponent > 0.01) then {
|
||||||
|
_slantRange = (_altitudeAGL / _verticalComponent) min _maxRange;
|
||||||
|
} else {
|
||||||
|
_slantRange = _maxRange;
|
||||||
|
};
|
||||||
|
|
||||||
|
_slantRange = _slantRange max 1;
|
||||||
|
_spiASL = _originASL vectorAdd (_cameraDir vectorMultiply _slantRange);
|
||||||
|
_spiASL set [2, getTerrainHeightASL [_spiASL select 0, _spiASL select 1]];
|
||||||
|
};
|
||||||
|
};
|
||||||
|
|
||||||
|
if (_slantRange <= 0) then {
|
||||||
|
_slantRange = (_originASL vectorDistance _spiASL) max 1;
|
||||||
|
};
|
||||||
|
|
||||||
|
private _spiAgl = ASLToAGL _spiASL;
|
||||||
|
private _spiWorld = [_spiAgl select 0, _spiAgl select 1, (_spiAgl select 2) max 0];
|
||||||
|
private _spiGeo = _spiWorld call armatak_client_fnc_convertClientLocation;
|
||||||
|
|
||||||
|
_drone setVariable ["armatak_uas_spi_asl", _spiASL, false];
|
||||||
|
_drone setVariable ["armatak_uas_spi_geo", _spiGeo, false];
|
||||||
|
|
||||||
|
[
|
||||||
|
round _azimuth,
|
||||||
|
round _elevation,
|
||||||
|
round _defaultFov,
|
||||||
|
round (_slantRange max 1),
|
||||||
|
_spiASL,
|
||||||
|
_spiGeo
|
||||||
|
]
|
||||||
|
|
||||||
|
|
||||||
@@ -20,10 +20,10 @@ if (side _unit == east) then {
|
|||||||
_callsign = getText (configOf _unit >> "displayName");
|
_callsign = getText (configOf _unit >> "displayName");
|
||||||
};
|
};
|
||||||
|
|
||||||
armatak_attribute_unit_callsign = _unit getVariable "armatak_attribute_unit_callsign";
|
private _unitCallsignOverride = _unit getVariable ["armatak_attribute_unit_callsign", ""];
|
||||||
|
|
||||||
if (!isNil "armatak_attribute_unit_callsign" or armatak_attribute_unit_callsign != '') then {
|
if (_unitCallsignOverride isNotEqualTo "") then {
|
||||||
_callsign = armatak_attribute_unit_callsign;
|
_callsign = _unitCallsignOverride;
|
||||||
};
|
};
|
||||||
|
|
||||||
_callsign
|
_callsign
|
||||||
|
|||||||
@@ -0,0 +1,30 @@
|
|||||||
|
params ["_longitudeInGame", "_latitudeInGame", "_altitude"];
|
||||||
|
|
||||||
|
private _mapWidth = 8192;
|
||||||
|
private _mapHeight = 8192;
|
||||||
|
|
||||||
|
// SW corner (used as origin)
|
||||||
|
private _SW_lat = 63.005389;
|
||||||
|
private _SW_lon = 22.638957;
|
||||||
|
|
||||||
|
// SE corner
|
||||||
|
private _SE_lat = 63.010092;
|
||||||
|
private _SE_lon = 22.800107;
|
||||||
|
|
||||||
|
// NW corner
|
||||||
|
private _NW_lat = 63.078713;
|
||||||
|
private _NW_lon = 22.628542;
|
||||||
|
|
||||||
|
private _edgeSE_lat = _SE_lat - _SW_lat;
|
||||||
|
private _edgeSE_lon = _SE_lon - _SW_lon;
|
||||||
|
|
||||||
|
private _edgeNW_lat = _NW_lat - _SW_lat;
|
||||||
|
private _edgeNW_lon = _NW_lon - _SW_lon;
|
||||||
|
|
||||||
|
private _fx = _longitudeInGame / _mapWidth;
|
||||||
|
private _fy = _latitudeInGame / _mapHeight;
|
||||||
|
|
||||||
|
private _realLat = _SW_lat + (_fx * _edgeSE_lat) + (_fy * _edgeNW_lat);
|
||||||
|
private _realLon = _SW_lon + (_fx * _edgeSE_lon) + (_fy * _edgeNW_lon);
|
||||||
|
|
||||||
|
[_realLat, _realLon, _altitude]
|
||||||
@@ -1,7 +1,10 @@
|
|||||||
PREP(3denEnrollModuleConfig);
|
PREP(3denEnrollModuleConfig);
|
||||||
PREP(3denTcpModuleConfig);
|
PREP(3denTcpModuleConfig);
|
||||||
|
PREP(addRouterEntities);
|
||||||
|
PREP(removeRouterEntities);
|
||||||
PREP(routerEntityAdd);
|
PREP(routerEntityAdd);
|
||||||
PREP(routerEntityRemove);
|
PREP(routerEntityRemove);
|
||||||
|
PREP(setRouterEntities);
|
||||||
PREP(startCotRouter);
|
PREP(startCotRouter);
|
||||||
PREP(ZeusEnrollModuleConfig);
|
PREP(ZeusEnrollModuleConfig);
|
||||||
PREP(ZeusTcpModuleConfig);
|
PREP(ZeusTcpModuleConfig);
|
||||||
|
|||||||
@@ -0,0 +1,28 @@
|
|||||||
|
#include "..\script_component.hpp"
|
||||||
|
/*
|
||||||
|
* Author: Valmo, Codex
|
||||||
|
* Adds entities to the server-side CoT router entity list.
|
||||||
|
*
|
||||||
|
* Arguments:
|
||||||
|
* 0: Entity or entities to publish through the CoT router <OBJECT|ARRAY>
|
||||||
|
*
|
||||||
|
* Return Value:
|
||||||
|
* Current routed entities <ARRAY>
|
||||||
|
*
|
||||||
|
* Public: Yes
|
||||||
|
*/
|
||||||
|
|
||||||
|
params [
|
||||||
|
["_entities", [], [objNull, []]]
|
||||||
|
];
|
||||||
|
|
||||||
|
private _toAdd = if (_entities isEqualType objNull) then {[_entities]} else {_entities};
|
||||||
|
private _routed = missionNamespace getVariable ["armatak_server_syncedUnits", []];
|
||||||
|
_routed append _toAdd;
|
||||||
|
_routed = _routed arrayIntersect _routed;
|
||||||
|
_routed = _routed select {!isNull _x && {alive _x}};
|
||||||
|
|
||||||
|
missionNamespace setVariable ["armatak_server_syncedUnits", _routed, true];
|
||||||
|
GVAR(syncedUnits) = _routed;
|
||||||
|
|
||||||
|
_routed
|
||||||
@@ -0,0 +1,26 @@
|
|||||||
|
#include "..\script_component.hpp"
|
||||||
|
/*
|
||||||
|
* Author: Valmo, Codex
|
||||||
|
* Removes entities from the server-side CoT router entity list.
|
||||||
|
*
|
||||||
|
* Arguments:
|
||||||
|
* 0: Entity or entities to remove from the CoT router <OBJECT|ARRAY>
|
||||||
|
*
|
||||||
|
* Return Value:
|
||||||
|
* Current routed entities <ARRAY>
|
||||||
|
*
|
||||||
|
* Public: Yes
|
||||||
|
*/
|
||||||
|
|
||||||
|
params [
|
||||||
|
["_entities", [], [objNull, []]]
|
||||||
|
];
|
||||||
|
|
||||||
|
private _toRemove = if (_entities isEqualType objNull) then {[_entities]} else {_entities};
|
||||||
|
private _routed = missionNamespace getVariable ["armatak_server_syncedUnits", []];
|
||||||
|
_routed = (_routed - _toRemove) select {!isNull _x && {alive _x}};
|
||||||
|
|
||||||
|
missionNamespace setVariable ["armatak_server_syncedUnits", _routed, true];
|
||||||
|
GVAR(syncedUnits) = _routed;
|
||||||
|
|
||||||
|
_routed
|
||||||
@@ -36,7 +36,7 @@ switch (false) do {
|
|||||||
|
|
||||||
GVAR(syncedUnits) pushBack _unit;
|
GVAR(syncedUnits) pushBack _unit;
|
||||||
|
|
||||||
missionNamespace setVariable ["armatak_server_syncedUnits", GVAR(syncedUnits)];
|
missionNamespace setVariable ["armatak_server_syncedUnits", GVAR(syncedUnits), true];
|
||||||
SETVAR(_unit,GVAR(isRouting),true);
|
SETVAR(_unit,GVAR(isRouting),true);
|
||||||
|
|
||||||
deleteVehicle _logic;
|
deleteVehicle _logic;
|
||||||
|
|||||||
@@ -34,7 +34,7 @@ switch (false) do {
|
|||||||
};
|
};
|
||||||
} forEach GVAR(syncedUnits);
|
} forEach GVAR(syncedUnits);
|
||||||
|
|
||||||
missionNamespace setVariable ["armatak_server_syncedUnits", GVAR(syncedUnits)];
|
missionNamespace setVariable ["armatak_server_syncedUnits", GVAR(syncedUnits), true];
|
||||||
SETVAR(_unit,GVAR(isRouting),false);
|
SETVAR(_unit,GVAR(isRouting),false);
|
||||||
|
|
||||||
deleteVehicle _logic;
|
deleteVehicle _logic;
|
||||||
|
|||||||
@@ -0,0 +1,25 @@
|
|||||||
|
#include "..\script_component.hpp"
|
||||||
|
/*
|
||||||
|
* Author: Valmo, Codex
|
||||||
|
* Replaces the server-side CoT router entity list with a de-duplicated list.
|
||||||
|
*
|
||||||
|
* Arguments:
|
||||||
|
* 0: Entities to publish through the CoT router <ARRAY>
|
||||||
|
*
|
||||||
|
* Return Value:
|
||||||
|
* Current routed entities <ARRAY>
|
||||||
|
*
|
||||||
|
* Public: Yes
|
||||||
|
*/
|
||||||
|
|
||||||
|
params [
|
||||||
|
["_entities", [], [[]]]
|
||||||
|
];
|
||||||
|
|
||||||
|
private _routed = _entities arrayIntersect _entities;
|
||||||
|
_routed = _routed select {!isNull _x && {alive _x}};
|
||||||
|
|
||||||
|
missionNamespace setVariable ["armatak_server_syncedUnits", _routed, true];
|
||||||
|
GVAR(syncedUnits) = _routed;
|
||||||
|
|
||||||
|
_routed
|
||||||
@@ -9,15 +9,33 @@ if (isNil { missionNamespace getVariable "armatak_server_syncedUnits" }) then {
|
|||||||
missionNamespace setVariable ["armatak_server_syncedUnits", []];
|
missionNamespace setVariable ["armatak_server_syncedUnits", []];
|
||||||
};
|
};
|
||||||
|
|
||||||
|
if (isNil { missionNamespace getVariable "armatak_server_clientClaimedEuds" }) then {
|
||||||
|
missionNamespace setVariable ["armatak_server_clientClaimedEuds", []];
|
||||||
|
};
|
||||||
|
|
||||||
GVAR(syncedUnits) = missionNamespace getVariable "armatak_server_syncedUnits";
|
GVAR(syncedUnits) = missionNamespace getVariable "armatak_server_syncedUnits";
|
||||||
|
|
||||||
[{
|
[{
|
||||||
GVAR(syncedUnits) = missionNamespace getVariable "armatak_server_syncedUnits";
|
GVAR(syncedUnits) = missionNamespace getVariable "armatak_server_syncedUnits";
|
||||||
|
private _clientClaimedEuds = missionNamespace getVariable ["armatak_server_clientClaimedEuds", []];
|
||||||
|
|
||||||
{
|
{
|
||||||
_objectType = _x call BIS_fnc_objectType;
|
_objectType = _x call BIS_fnc_objectType;
|
||||||
switch (true) do {
|
switch (true) do {
|
||||||
case ((_objectType select 0) == "Soldier"): {
|
case ((_objectType select 0) == "Soldier"): {
|
||||||
|
private _uuid = _x call armatak_fnc_extract_uuid;
|
||||||
|
private _isClientEud = _x getVariable [QEGVAR(client,eudConnected), false];
|
||||||
|
if (_isClientEud) exitWith {
|
||||||
|
if !(_uuid in _clientClaimedEuds) then {
|
||||||
|
private _position = _x call armatak_client_fnc_extractClientPosition;
|
||||||
|
private _deleteCot = [_uuid, "a-f-G-U-C-I", _position select 1, _position select 2, _position select 3];
|
||||||
|
"armatak" callExtension ["tcp_socket:cot:delete", [_deleteCot]];
|
||||||
|
_clientClaimedEuds pushBack _uuid;
|
||||||
|
};
|
||||||
|
};
|
||||||
|
|
||||||
|
_clientClaimedEuds = _clientClaimedEuds - [_uuid];
|
||||||
|
|
||||||
_callsign = [_x] call armatak_fnc_extract_unit_callsign;
|
_callsign = [_x] call armatak_fnc_extract_unit_callsign;
|
||||||
_group_name = [group _x] call armatak_fnc_extract_group_color;
|
_group_name = [group _x] call armatak_fnc_extract_group_color;
|
||||||
_group_role = [_x] call armatak_fnc_extract_group_role;
|
_group_role = [_x] call armatak_fnc_extract_group_role;
|
||||||
@@ -25,23 +43,38 @@ GVAR(syncedUnits) = missionNamespace getVariable "armatak_server_syncedUnits";
|
|||||||
[_x, _callsign, _group_name, _group_role] call armatak_fnc_send_eud_cot;
|
[_x, _callsign, _group_name, _group_role] call armatak_fnc_send_eud_cot;
|
||||||
[_x] call armatak_fnc_send_digital_pointer_cot;
|
[_x] call armatak_fnc_send_digital_pointer_cot;
|
||||||
};
|
};
|
||||||
|
case (unitIsUAV _x): {
|
||||||
|
if !(_x getVariable ["armatak_uav_mavlink_broadcasting", false]) then {
|
||||||
|
_atak_type = [_x] call armatak_fnc_extract_role;
|
||||||
|
_callsign = [_x] call armatak_fnc_extract_marker_callsign;
|
||||||
|
|
||||||
|
[_x, _atak_type, _callsign] call armatak_fnc_send_drone_cot;
|
||||||
|
_x call armatak_fnc_extract_sensor_data;
|
||||||
|
[_x] call armatak_fnc_send_digital_pointer_cot;
|
||||||
|
};
|
||||||
|
};
|
||||||
case ((_objectType select 0) == "Vehicle"): {
|
case ((_objectType select 0) == "Vehicle"): {
|
||||||
_atak_type = [_x] call armatak_fnc_extract_role;
|
_atak_type = [_x] call armatak_fnc_extract_role;
|
||||||
_callsign = [_x] call armatak_fnc_extract_marker_callsign;
|
_callsign = [_x] call armatak_fnc_extract_marker_callsign;
|
||||||
|
|
||||||
[_x, _atak_type, _callsign] call armatak_fnc_send_marker_cot;
|
[_x, _atak_type, _callsign] call armatak_fnc_send_marker_cot;
|
||||||
_x call armatak_fnc_extract_sensor_data;
|
_x call armatak_fnc_extract_sensor_data;
|
||||||
|
[_x] call armatak_fnc_send_digital_pointer_cot;
|
||||||
};
|
};
|
||||||
case ((_objectType select 0) == "VehicleAutonomous"): {
|
case ((_objectType select 0) == "VehicleAutonomous"): {
|
||||||
_atak_type = [_x] call armatak_fnc_extract_role;
|
if !(_x getVariable ["armatak_uav_mavlink_broadcasting", false]) then {
|
||||||
_callsign = [_x] call armatak_fnc_extract_marker_callsign;
|
_atak_type = [_x] call armatak_fnc_extract_role;
|
||||||
|
_callsign = [_x] call armatak_fnc_extract_marker_callsign;
|
||||||
|
|
||||||
[_x, _atak_type, _callsign] call armatak_fnc_send_drone_cot;
|
[_x, _atak_type, _callsign] call armatak_fnc_send_drone_cot;
|
||||||
[_x] call armatak_fnc_send_digital_pointer_cot;
|
_x call armatak_fnc_extract_sensor_data;
|
||||||
_x call armatak_fnc_extract_sensor_data;
|
[_x] call armatak_fnc_send_digital_pointer_cot;
|
||||||
|
};
|
||||||
};
|
};
|
||||||
};
|
};
|
||||||
} forEach GVAR(syncedUnits);
|
} forEach GVAR(syncedUnits);
|
||||||
|
|
||||||
|
missionNamespace setVariable ["armatak_server_clientClaimedEuds", _clientClaimedEuds];
|
||||||
}, 1, []] call CBA_fnc_addPerFrameHandler;
|
}, 1, []] call CBA_fnc_addPerFrameHandler;
|
||||||
|
|
||||||
true
|
true
|
||||||
|
|||||||
@@ -0,0 +1 @@
|
|||||||
|
armatak\armatak\addons\uav
|
||||||
@@ -9,3 +9,9 @@ class Extended_PreInit_EventHandlers {
|
|||||||
init = QUOTE(call COMPILE_SCRIPT(XEH_preInit));
|
init = QUOTE(call COMPILE_SCRIPT(XEH_preInit));
|
||||||
};
|
};
|
||||||
};
|
};
|
||||||
|
|
||||||
|
class Extended_PostInit_EventHandlers {
|
||||||
|
class ADDON {
|
||||||
|
init = QUOTE(call COMPILE_SCRIPT(XEH_postInit));
|
||||||
|
};
|
||||||
|
};
|
||||||
@@ -0,0 +1,6 @@
|
|||||||
|
PREP(startMavlinkBroadcast);
|
||||||
|
PREP(stopMavlinkBroadcast);
|
||||||
|
PREP(updateMavlinkBroadcast);
|
||||||
|
PREP(resolveVideoUri);
|
||||||
|
PREP(handleMavlinkCallback);
|
||||||
|
PREP(parseMavlinkCallbackData);
|
||||||
@@ -0,0 +1,5 @@
|
|||||||
|
#include "script_component.hpp"
|
||||||
|
|
||||||
|
if (!hasInterface) exitWith {};
|
||||||
|
|
||||||
|
SETVAR(player,GVAR(mavlinkPFH),-1);
|
||||||
@@ -3,15 +3,13 @@
|
|||||||
class CfgPatches {
|
class CfgPatches {
|
||||||
class ADDON {
|
class ADDON {
|
||||||
name = COMPONENT_NAME;
|
name = COMPONENT_NAME;
|
||||||
units[] = {
|
units[] = {};
|
||||||
//QGVAR(videoModule)
|
|
||||||
};
|
|
||||||
weapons[] = {};
|
weapons[] = {};
|
||||||
requiredAddons[] = {
|
requiredAddons[] = {
|
||||||
"cba_main",
|
"cba_main",
|
||||||
"ace_main",
|
"ace_main",
|
||||||
"armatak_main",
|
"armatak_main",
|
||||||
"armatak_server"
|
"armatak_client"
|
||||||
};
|
};
|
||||||
requiredVersion = REQUIRED_VERSION;
|
requiredVersion = REQUIRED_VERSION;
|
||||||
author = PROJECT_AUTHOR;
|
author = PROJECT_AUTHOR;
|
||||||
@@ -20,4 +18,3 @@ class CfgPatches {
|
|||||||
};
|
};
|
||||||
|
|
||||||
#include "CfgEventHandlers.hpp"
|
#include "CfgEventHandlers.hpp"
|
||||||
//#include "CfgVehicles.hpp"
|
|
||||||
@@ -0,0 +1,382 @@
|
|||||||
|
#include "..\script_component.hpp"
|
||||||
|
|
||||||
|
params ["_function", ["_data", "", [""]]];
|
||||||
|
|
||||||
|
if (!hasInterface) exitWith {};
|
||||||
|
|
||||||
|
private _payload = [_data] call FUNC(parseMavlinkCallbackData);
|
||||||
|
private _uav = getConnectedUAV player;
|
||||||
|
if (isNull _uav) then {
|
||||||
|
_uav = player getVariable [QGVAR(broadcastingUav), objNull];
|
||||||
|
};
|
||||||
|
|
||||||
|
if (isNull _uav) exitWith {
|
||||||
|
"armatak" callExtension ["log", [["warn", format ["Ignoring MAVLINK UDP callback %1 because no UAV is connected: %2", _function, _data]]]];
|
||||||
|
};
|
||||||
|
|
||||||
|
private _number = {
|
||||||
|
params ["_key", ["_default", 0]];
|
||||||
|
private _raw = _payload getOrDefault [_key, str _default];
|
||||||
|
private _value = parseNumber _raw;
|
||||||
|
if (!finite _value) exitWith {_default};
|
||||||
|
_value
|
||||||
|
};
|
||||||
|
|
||||||
|
private _uavGroup = {
|
||||||
|
params ["_vehicle"];
|
||||||
|
private _crew = crew _vehicle;
|
||||||
|
if (_crew isEqualTo []) exitWith {grpNull};
|
||||||
|
group (_crew select 0)
|
||||||
|
};
|
||||||
|
|
||||||
|
private _clearWaypoints = {
|
||||||
|
params ["_group"];
|
||||||
|
if (isNull _group) exitWith {};
|
||||||
|
for "_i" from ((count waypoints _group) - 1) to 0 step -1 do {
|
||||||
|
deleteWaypoint [_group, _i];
|
||||||
|
};
|
||||||
|
};
|
||||||
|
|
||||||
|
private _clearUavRoute = {
|
||||||
|
private _group = [_uav] call _uavGroup;
|
||||||
|
if (isNull _group) exitWith {false};
|
||||||
|
[_group] call _clearWaypoints;
|
||||||
|
_uav setVariable ["armatak_uas_mission_items", [], true];
|
||||||
|
true
|
||||||
|
};
|
||||||
|
|
||||||
|
private _geoToAtl = {
|
||||||
|
params ["_vehicle", "_lat", "_lon", ["_alt", -1]];
|
||||||
|
|
||||||
|
private _current = [_vehicle] call EFUNC(client,extractClientPosition);
|
||||||
|
private _currentLat = _current select 1;
|
||||||
|
private _currentLon = _current select 2;
|
||||||
|
private _currentAtl = getPosATL _vehicle;
|
||||||
|
|
||||||
|
private _northM = (_lat - _currentLat) * 111320;
|
||||||
|
private _eastM = (_lon - _currentLon) * (111320 * (cos _currentLat));
|
||||||
|
|
||||||
|
[
|
||||||
|
(_currentAtl select 0) + _eastM,
|
||||||
|
(_currentAtl select 1) + _northM,
|
||||||
|
if (_alt >= 0) then {_alt} else {_currentAtl select 2}
|
||||||
|
]
|
||||||
|
};
|
||||||
|
|
||||||
|
private _commandMove = {
|
||||||
|
params ["_vehicle", "_positionAtl", ["_type", "MOVE"], ["_radius", 80], ["_completion", 50]];
|
||||||
|
|
||||||
|
private _group = [_vehicle] call _uavGroup;
|
||||||
|
if (isNull _group) exitWith {false};
|
||||||
|
|
||||||
|
[_group] call _clearWaypoints;
|
||||||
|
|
||||||
|
_vehicle engineOn true;
|
||||||
|
_vehicle setVariable ["armatak_uas_armed", true, true];
|
||||||
|
_vehicle setFuel ((fuel _vehicle) max 0.1);
|
||||||
|
_vehicle flyInHeight ((_positionAtl select 2) max 10);
|
||||||
|
_vehicle doMove _positionAtl;
|
||||||
|
|
||||||
|
private _wp = _group addWaypoint [_positionAtl, 0];
|
||||||
|
_wp setWaypointType _type;
|
||||||
|
_wp setWaypointBehaviour "CARELESS";
|
||||||
|
_wp setWaypointCombatMode "BLUE";
|
||||||
|
_wp setWaypointSpeed "NORMAL";
|
||||||
|
_wp setWaypointCompletionRadius _completion;
|
||||||
|
|
||||||
|
if (_type == "LOITER") then {
|
||||||
|
_wp setWaypointLoiterRadius (_radius max 25);
|
||||||
|
_wp setWaypointLoiterType "CIRCLE_L";
|
||||||
|
};
|
||||||
|
|
||||||
|
true
|
||||||
|
};
|
||||||
|
|
||||||
|
private _appendMissionWaypoint = {
|
||||||
|
params ["_vehicle", "_positionAtl", "_command", "_seq", ["_radius", 80]];
|
||||||
|
|
||||||
|
private _group = [_vehicle] call _uavGroup;
|
||||||
|
if (isNull _group) exitWith {false};
|
||||||
|
|
||||||
|
private _type = switch (_command) do {
|
||||||
|
case 17;
|
||||||
|
case 18;
|
||||||
|
case 19;
|
||||||
|
case 31: {"LOITER"};
|
||||||
|
case 21: {"MOVE"};
|
||||||
|
default {"MOVE"};
|
||||||
|
};
|
||||||
|
|
||||||
|
private _wp = _group addWaypoint [_positionAtl, 0];
|
||||||
|
_wp setWaypointType _type;
|
||||||
|
_wp setWaypointBehaviour "CARELESS";
|
||||||
|
_wp setWaypointCombatMode "BLUE";
|
||||||
|
_wp setWaypointSpeed "NORMAL";
|
||||||
|
_wp setWaypointCompletionRadius 35;
|
||||||
|
|
||||||
|
if (_type == "LOITER") then {
|
||||||
|
_wp setWaypointLoiterRadius (_radius max 25);
|
||||||
|
_wp setWaypointLoiterType "CIRCLE_L";
|
||||||
|
};
|
||||||
|
if (_command == 21) then {
|
||||||
|
_wp setWaypointStatements ["true", "(vehicle this) land 'LAND'"];
|
||||||
|
};
|
||||||
|
|
||||||
|
private _items = _vehicle getVariable ["armatak_uas_mission_items", []];
|
||||||
|
_items pushBack [_seq, _command, _positionAtl];
|
||||||
|
_vehicle setVariable ["armatak_uas_mission_items", _items, true];
|
||||||
|
|
||||||
|
true
|
||||||
|
};
|
||||||
|
|
||||||
|
private _commandName = _payload getOrDefault ["command_name", "UNKNOWN"];
|
||||||
|
private _command = [_payload getOrDefault ["command", "-1"]] call BIS_fnc_parseNumber;
|
||||||
|
private _callsign = [_uav] call armatak_fnc_extract_marker_callsign;
|
||||||
|
|
||||||
|
private _applySpeed = {
|
||||||
|
params ["_speed"];
|
||||||
|
if (_speed <= 0) exitWith {false};
|
||||||
|
_uav limitSpeed _speed;
|
||||||
|
systemChat format ["ATAK SPEED %1m/s %2", round _speed, _callsign];
|
||||||
|
true
|
||||||
|
};
|
||||||
|
|
||||||
|
private _applyMode = {
|
||||||
|
params ["_mode"];
|
||||||
|
|
||||||
|
switch (_mode) do {
|
||||||
|
case 4: {
|
||||||
|
_uav engineOn true;
|
||||||
|
_uav setVariable ["armatak_uas_armed", true, true];
|
||||||
|
_uav setFuel ((fuel _uav) max 0.1);
|
||||||
|
systemChat format ["ATAK GUIDED %1", _callsign];
|
||||||
|
};
|
||||||
|
case 5: {
|
||||||
|
private _pos = getPosATL _uav;
|
||||||
|
[_uav, _pos, "LOITER", 80, 25] call _commandMove;
|
||||||
|
systemChat format ["ATAK LOITER %1", _callsign];
|
||||||
|
};
|
||||||
|
case 6;
|
||||||
|
case 21;
|
||||||
|
case 27: {
|
||||||
|
private _home = _uav getVariable ["armatak_uas_home_atl", getPosATL _uav];
|
||||||
|
_home set [2, ((_home select 2) max 60)];
|
||||||
|
[_uav, _home, "MOVE", 80, 60] call _commandMove;
|
||||||
|
systemChat format ["ATAK RTL %1", _callsign];
|
||||||
|
};
|
||||||
|
case 9: {
|
||||||
|
private _pos = getPosATL _uav;
|
||||||
|
_pos set [2, 0];
|
||||||
|
[_uav, _pos, "MOVE", 30, 20] call _commandMove;
|
||||||
|
_uav flyInHeight 0;
|
||||||
|
systemChat format ["ATAK LAND %1", _callsign];
|
||||||
|
};
|
||||||
|
default {
|
||||||
|
"armatak" callExtension ["log", [["info", format ["Unhandled MAVLINK mode %1 for UAV %2", _mode, _uav]]]];
|
||||||
|
};
|
||||||
|
};
|
||||||
|
};
|
||||||
|
|
||||||
|
private _setHomeFromGeo = {
|
||||||
|
params ["_lat", "_lon", "_alt"];
|
||||||
|
if (_lat == 0 && {_lon == 0}) exitWith {false};
|
||||||
|
private _homeAtl = [_uav, _lat, _lon, _alt] call _geoToAtl;
|
||||||
|
_uav setVariable ["armatak_uas_home_atl", _homeAtl, true];
|
||||||
|
_uav setVariable ["armatak_uas_home_geo", [_lat, _lon, _alt], true];
|
||||||
|
systemChat format ["ATAK HOME %1", _callsign];
|
||||||
|
true
|
||||||
|
};
|
||||||
|
|
||||||
|
switch (_function) do {
|
||||||
|
case "COMMAND_LONG": {
|
||||||
|
switch (_command) do {
|
||||||
|
case 176: {
|
||||||
|
private _mode = ["param2", -1] call _number;
|
||||||
|
if (_mode < 0) then {
|
||||||
|
_mode = ["param1", -1] call _number;
|
||||||
|
};
|
||||||
|
[_mode] call _applyMode;
|
||||||
|
};
|
||||||
|
case 178: {
|
||||||
|
private _speed = ["param2", -1] call _number;
|
||||||
|
if (_speed <= 0) then {
|
||||||
|
_speed = ["param1", -1] call _number;
|
||||||
|
};
|
||||||
|
[_speed] call _applySpeed;
|
||||||
|
};
|
||||||
|
case 179: {
|
||||||
|
private _useCurrent = (["param1", 0] call _number) >= 1;
|
||||||
|
if (_useCurrent) then {
|
||||||
|
private _pos = [_uav] call EFUNC(client,extractClientPosition);
|
||||||
|
private _relAlt = ((getPosATL _uav) select 2) max 0;
|
||||||
|
private _homeAtl = getPosATL _uav;
|
||||||
|
_uav setVariable ["armatak_uas_home_atl", _homeAtl, true];
|
||||||
|
_uav setVariable ["armatak_uas_home_geo", [_pos select 1, _pos select 2, (_pos select 3) - _relAlt], true];
|
||||||
|
systemChat format ["ATAK HOME %1", _callsign];
|
||||||
|
} else {
|
||||||
|
[["param5", 0] call _number, ["param6", 0] call _number, ["param7", 0] call _number] call _setHomeFromGeo;
|
||||||
|
};
|
||||||
|
};
|
||||||
|
case 400: {
|
||||||
|
private _doArm = (["param1", 0] call _number) >= 1;
|
||||||
|
_uav engineOn _doArm;
|
||||||
|
_uav setVariable ["armatak_uas_armed", _doArm, true];
|
||||||
|
if (_doArm) then {
|
||||||
|
_uav setFuel ((fuel _uav) max 0.1);
|
||||||
|
};
|
||||||
|
systemChat format ["ATAK %1 %2", ["DISARM", "ARM"] select _doArm, _callsign];
|
||||||
|
"armatak" callExtension ["log", [["info", format ["Applied MAVLINK ARM=%1 to UAV %2", _doArm, _uav]]]];
|
||||||
|
};
|
||||||
|
case 22: {
|
||||||
|
private _alt = (["param7", 75] call _number) max 10;
|
||||||
|
private _pos = getPosATL _uav;
|
||||||
|
_pos set [2, _alt];
|
||||||
|
[_uav, _pos, "MOVE", 80, 25] call _commandMove;
|
||||||
|
_uav setVelocityModelSpace [0, 15, 8];
|
||||||
|
systemChat format ["ATAK TAKEOFF %1m %2", round _alt, _callsign];
|
||||||
|
};
|
||||||
|
case 21: {
|
||||||
|
[9] call _applyMode;
|
||||||
|
};
|
||||||
|
case 20: {
|
||||||
|
[6] call _applyMode;
|
||||||
|
};
|
||||||
|
case 16: {
|
||||||
|
private _lat = ["param5", 0] call _number;
|
||||||
|
private _lon = ["param6", 0] call _number;
|
||||||
|
private _alt = ["param7", -1] call _number;
|
||||||
|
private _pos = [_uav, _lat, _lon, _alt] call _geoToAtl;
|
||||||
|
[_uav, _pos, "MOVE", 80, 50] call _commandMove;
|
||||||
|
systemChat format ["ATAK MOVE %1", _callsign];
|
||||||
|
};
|
||||||
|
case 17: {
|
||||||
|
private _lat = ["param5", 0] call _number;
|
||||||
|
private _lon = ["param6", 0] call _number;
|
||||||
|
private _alt = ["param7", -1] call _number;
|
||||||
|
private _radius = abs (["param3", 80] call _number);
|
||||||
|
private _pos = [_uav, _lat, _lon, _alt] call _geoToAtl;
|
||||||
|
[_uav, _pos, "LOITER", _radius, 30] call _commandMove;
|
||||||
|
systemChat format ["ATAK LOITER %1", _callsign];
|
||||||
|
};
|
||||||
|
case 43000: {
|
||||||
|
private _speed = ["param2", -1] call _number;
|
||||||
|
if (_speed <= 0) then {
|
||||||
|
_speed = ["param1", -1] call _number;
|
||||||
|
};
|
||||||
|
[_speed] call _applySpeed;
|
||||||
|
};
|
||||||
|
case 43001: {
|
||||||
|
private _alt = ["param1", -1] call _number;
|
||||||
|
if (_alt < 0) then {
|
||||||
|
_alt = ["param7", -1] call _number;
|
||||||
|
};
|
||||||
|
private _pos = getPosATL _uav;
|
||||||
|
_pos set [2, _alt max 10];
|
||||||
|
[_uav, _pos, "MOVE", 80, 25] call _commandMove;
|
||||||
|
systemChat format ["ATAK ALT %1m %2", round (_pos select 2), _callsign];
|
||||||
|
};
|
||||||
|
case 43002: {
|
||||||
|
private _heading = ["param1", -1] call _number;
|
||||||
|
if (_heading >= 0) then {
|
||||||
|
_uav setDir _heading;
|
||||||
|
systemChat format ["ATAK HDG %1 %2", round _heading, _callsign];
|
||||||
|
};
|
||||||
|
};
|
||||||
|
default {
|
||||||
|
"armatak" callExtension ["log", [["info", format ["Unhandled MAVLINK COMMAND_LONG %1 (%2): %3", _command, _commandName, _data]]]];
|
||||||
|
};
|
||||||
|
};
|
||||||
|
};
|
||||||
|
case "COMMAND_INT": {
|
||||||
|
private _lat = (["x", 0] call _number) / 1e7;
|
||||||
|
private _lon = (["y", 0] call _number) / 1e7;
|
||||||
|
private _alt = ["z", -1] call _number;
|
||||||
|
|
||||||
|
switch (_command) do {
|
||||||
|
case 16: {
|
||||||
|
private _pos = [_uav, _lat, _lon, _alt] call _geoToAtl;
|
||||||
|
[_uav, _pos, "MOVE", 80, 50] call _commandMove;
|
||||||
|
systemChat format ["ATAK MOVE %1", _callsign];
|
||||||
|
};
|
||||||
|
case 17;
|
||||||
|
case 192: {
|
||||||
|
private _radius = abs (["param3", 80] call _number);
|
||||||
|
private _direction = ["CIRCLE_L", "CIRCLE_R"] select ((["param4", 0] call _number) < 0);
|
||||||
|
private _pos = [_uav, _lat, _lon, _alt] call _geoToAtl;
|
||||||
|
private _type = ["MOVE", "LOITER"] select (_radius > 1);
|
||||||
|
[_uav, _pos, _type, _radius, 30] call _commandMove;
|
||||||
|
if (_type == "LOITER") then {
|
||||||
|
private _group = [_uav] call _uavGroup;
|
||||||
|
private _waypoints = waypoints _group;
|
||||||
|
if (_waypoints isNotEqualTo []) then {
|
||||||
|
(_waypoints select -1) setWaypointLoiterType _direction;
|
||||||
|
};
|
||||||
|
};
|
||||||
|
systemChat format ["ATAK %1 %2", _type, _callsign];
|
||||||
|
};
|
||||||
|
default {
|
||||||
|
"armatak" callExtension ["log", [["info", format ["Unhandled MAVLINK COMMAND_INT %1 (%2): %3", _command, _commandName, _data]]]];
|
||||||
|
};
|
||||||
|
};
|
||||||
|
};
|
||||||
|
case "MISSION_COUNT": {
|
||||||
|
private _count = ["count", 0] call _number;
|
||||||
|
[] call _clearUavRoute;
|
||||||
|
systemChat format ["ATAK ROUTE %1 pts %2", round _count, _callsign];
|
||||||
|
"armatak" callExtension ["log", [["info", format ["Receiving MAVLINK mission count=%1 for UAV %2", _count, _uav]]]];
|
||||||
|
};
|
||||||
|
case "MISSION_CLEAR_ALL": {
|
||||||
|
[] call _clearUavRoute;
|
||||||
|
systemChat format ["ATAK ROUTE CLEAR %1", _callsign];
|
||||||
|
};
|
||||||
|
case "MISSION_SET_CURRENT": {
|
||||||
|
private _seq = ["seq", 0] call _number;
|
||||||
|
"armatak" callExtension ["log", [["info", format ["MAVLINK mission set current seq=%1 for UAV %2", _seq, _uav]]]];
|
||||||
|
};
|
||||||
|
case "MISSION_ITEM";
|
||||||
|
case "MISSION_ITEM_INT": {
|
||||||
|
private _seq = ["seq", 0] call _number;
|
||||||
|
private _missionCommand = ["command", -1] call _number;
|
||||||
|
private _lat = ["lat", 0] call _number;
|
||||||
|
private _lon = ["lon", 0] call _number;
|
||||||
|
private _alt = ["alt", -1] call _number;
|
||||||
|
|
||||||
|
if (_lat == 0 && {_lon == 0}) exitWith {
|
||||||
|
"armatak" callExtension ["log", [["warn", format ["Ignoring MAVLINK mission item at zero coordinate: %1", _data]]]];
|
||||||
|
};
|
||||||
|
|
||||||
|
private _pos = [_uav, _lat, _lon, _alt] call _geoToAtl;
|
||||||
|
private _radius = abs (["param3", 80] call _number);
|
||||||
|
[_uav, _pos, _missionCommand, _seq, _radius] call _appendMissionWaypoint;
|
||||||
|
_uav engineOn true;
|
||||||
|
_uav setVariable ["armatak_uas_armed", true, true];
|
||||||
|
_uav setFuel ((fuel _uav) max 0.1);
|
||||||
|
_uav flyInHeight ((_pos select 2) max 10);
|
||||||
|
systemChat format ["ATAK ROUTE WP %1 %2", round _seq, _callsign];
|
||||||
|
"armatak" callExtension ["log", [["info", format ["Added MAVLINK mission item seq=%1 command=%2 posATL=%3 for UAV %4", _seq, _missionCommand, _pos, _uav]]]];
|
||||||
|
};
|
||||||
|
case "SET_HOME_POSITION": {
|
||||||
|
[["lat", 0] call _number, ["lon", 0] call _number, ["alt", 0] call _number] call _setHomeFromGeo;
|
||||||
|
};
|
||||||
|
case "SET_POSITION_TARGET_GLOBAL_INT": {
|
||||||
|
private _lat = ["lat", 0] call _number;
|
||||||
|
private _lon = ["lon", 0] call _number;
|
||||||
|
private _alt = ["alt", -1] call _number;
|
||||||
|
private _pos = [_uav, _lat, _lon, _alt] call _geoToAtl;
|
||||||
|
[_uav, _pos, "MOVE", 80, 40] call _commandMove;
|
||||||
|
systemChat format ["ATAK GUIDED MOVE %1", _callsign];
|
||||||
|
};
|
||||||
|
case "SET_MODE": {
|
||||||
|
private _mode = ["custom_mode", -1] call _number;
|
||||||
|
[_mode] call _applyMode;
|
||||||
|
};
|
||||||
|
case "COMMAND_ACK": {
|
||||||
|
"armatak" callExtension ["log", [["info", format ["Received MAVLINK COMMAND_ACK %1 (%2): %3", _command, _commandName, _data]]]];
|
||||||
|
};
|
||||||
|
case "MANUAL_CONTROL": {
|
||||||
|
"armatak" callExtension ["log", [["info", format ["Received MAVLINK MANUAL_CONTROL: %1", _data]]]];
|
||||||
|
};
|
||||||
|
default {
|
||||||
|
"armatak" callExtension ["log", [["info", format ["Unhandled MAVLINK UDP callback %1: %2", _function, _data]]]];
|
||||||
|
};
|
||||||
|
};
|
||||||
@@ -0,0 +1,17 @@
|
|||||||
|
#include "..\script_component.hpp"
|
||||||
|
|
||||||
|
params [["_raw", "", [""]]];
|
||||||
|
|
||||||
|
private _pairs = createHashMap;
|
||||||
|
|
||||||
|
{
|
||||||
|
private _entry = _x;
|
||||||
|
private _separatorIndex = _entry find "=";
|
||||||
|
if (_separatorIndex > 0) then {
|
||||||
|
private _key = _entry select [0, _separatorIndex];
|
||||||
|
private _value = _entry select [_separatorIndex + 1];
|
||||||
|
_pairs set [_key, _value];
|
||||||
|
};
|
||||||
|
} forEach (_raw splitString ";");
|
||||||
|
|
||||||
|
_pairs
|
||||||
@@ -0,0 +1,45 @@
|
|||||||
|
#include "..\script_component.hpp"
|
||||||
|
|
||||||
|
params [["_uav", objNull, [objNull]]];
|
||||||
|
|
||||||
|
private _defaultVideoUri = "rtsp://undefined:554/fpv";
|
||||||
|
private _activelyControlledUav = if (!isNull player) then {getConnectedUAV player} else {objNull};
|
||||||
|
|
||||||
|
private _normalize = {
|
||||||
|
params ["_rawUrl"];
|
||||||
|
|
||||||
|
private _url = trim _rawUrl;
|
||||||
|
if (_url isEqualTo "") exitWith {""};
|
||||||
|
|
||||||
|
if (_url find "://" >= 0) exitWith {_url};
|
||||||
|
|
||||||
|
if (_url find "/" >= 0) exitWith {
|
||||||
|
format ["rtsp://%1", _url]
|
||||||
|
};
|
||||||
|
|
||||||
|
format ["rtp://%1", _url]
|
||||||
|
};
|
||||||
|
|
||||||
|
if (!isNull _uav) then {
|
||||||
|
private _objectVideoUrl = [_uav] call armatak_fnc_extract_marker_video_url;
|
||||||
|
private _normalizedObjectVideoUrl = [_objectVideoUrl] call _normalize;
|
||||||
|
if (_normalizedObjectVideoUrl isNotEqualTo "") exitWith {
|
||||||
|
_normalizedObjectVideoUrl
|
||||||
|
};
|
||||||
|
|
||||||
|
private _activeSessionVideoUrl = player getVariable [QEGVAR(client,video_feed_url), ""];
|
||||||
|
private _normalizedActiveSessionVideoUrl = [_activeSessionVideoUrl] call _normalize;
|
||||||
|
if (_normalizedActiveSessionVideoUrl isNotEqualTo "") exitWith {
|
||||||
|
_normalizedActiveSessionVideoUrl
|
||||||
|
};
|
||||||
|
|
||||||
|
_defaultVideoUri
|
||||||
|
};
|
||||||
|
|
||||||
|
private _sessionVideoUrl = player getVariable [QEGVAR(client,video_feed_url), ""];
|
||||||
|
private _normalizedSessionVideoUrl = [_sessionVideoUrl] call _normalize;
|
||||||
|
if (_normalizedSessionVideoUrl isNotEqualTo "") exitWith {
|
||||||
|
_normalizedSessionVideoUrl
|
||||||
|
};
|
||||||
|
|
||||||
|
_defaultVideoUri
|
||||||
@@ -0,0 +1,16 @@
|
|||||||
|
#include "..\script_component.hpp"
|
||||||
|
|
||||||
|
if (!hasInterface) exitWith {};
|
||||||
|
|
||||||
|
private _existingPfh = player getVariable [QGVAR(mavlinkPFH), -1];
|
||||||
|
if (_existingPfh >= 0) then {
|
||||||
|
[_existingPfh] call CBA_fnc_removePerFrameHandler;
|
||||||
|
};
|
||||||
|
|
||||||
|
player setVariable [QGVAR(broadcastingUav), objNull];
|
||||||
|
|
||||||
|
private _pfh = [{
|
||||||
|
call FUNC(updateMavlinkBroadcast);
|
||||||
|
}, 0.5, []] call CBA_fnc_addPerFrameHandler;
|
||||||
|
|
||||||
|
player setVariable [QGVAR(mavlinkPFH), _pfh];
|
||||||
@@ -0,0 +1,17 @@
|
|||||||
|
#include "..\script_component.hpp"
|
||||||
|
|
||||||
|
if (!hasInterface) exitWith {};
|
||||||
|
|
||||||
|
private _existingPfh = player getVariable [QGVAR(mavlinkPFH), -1];
|
||||||
|
if (_existingPfh >= 0) then {
|
||||||
|
[_existingPfh] call CBA_fnc_removePerFrameHandler;
|
||||||
|
player setVariable [QGVAR(mavlinkPFH), -1];
|
||||||
|
};
|
||||||
|
|
||||||
|
private _broadcastingUav = player getVariable [QGVAR(broadcastingUav), objNull];
|
||||||
|
if (!isNull _broadcastingUav) then {
|
||||||
|
_broadcastingUav setVariable ["armatak_uav_mavlink_broadcasting", false, true];
|
||||||
|
systemChat "UAV broadcasting stopped";
|
||||||
|
};
|
||||||
|
|
||||||
|
player setVariable [QGVAR(broadcastingUav), objNull];
|
||||||
@@ -0,0 +1,122 @@
|
|||||||
|
#include "..\script_component.hpp"
|
||||||
|
|
||||||
|
private _broadcastingUav = player getVariable [QGVAR(broadcastingUav), objNull];
|
||||||
|
|
||||||
|
if !(player getVariable [QEGVAR(client,eudConnected), false]) exitWith {
|
||||||
|
if (!isNull _broadcastingUav) then {
|
||||||
|
_broadcastingUav setVariable ["armatak_uav_mavlink_broadcasting", false, true];
|
||||||
|
player setVariable [QGVAR(broadcastingUav), objNull];
|
||||||
|
};
|
||||||
|
};
|
||||||
|
|
||||||
|
private _uav = getConnectedUAV player;
|
||||||
|
if (isNull _uav) then {
|
||||||
|
_uav = _broadcastingUav;
|
||||||
|
};
|
||||||
|
|
||||||
|
if (isNull _uav || {!alive _uav}) exitWith {
|
||||||
|
if (!isNull _broadcastingUav) then {
|
||||||
|
_broadcastingUav setVariable ["armatak_uav_mavlink_broadcasting", false, true];
|
||||||
|
player setVariable [QGVAR(broadcastingUav), objNull];
|
||||||
|
systemChat "UAV broadcasting stopped";
|
||||||
|
"armatak" callExtension ["log", [["info", "UAV broadcasting stopped because the UAV is no longer available"]]];
|
||||||
|
};
|
||||||
|
};
|
||||||
|
|
||||||
|
if (_broadcastingUav isNotEqualTo _uav) then {
|
||||||
|
if (!isNull _broadcastingUav) then {
|
||||||
|
_broadcastingUav setVariable ["armatak_uav_mavlink_broadcasting", false, true];
|
||||||
|
};
|
||||||
|
player setVariable [QGVAR(broadcastingUav), _uav];
|
||||||
|
_uav setVariable ["armatak_uav_mavlink_broadcasting", true, true];
|
||||||
|
private _callsign = [_uav] call armatak_fnc_extract_marker_callsign;
|
||||||
|
systemChat format ["Broadcasting UAV %1", _callsign];
|
||||||
|
"armatak" callExtension ["log", [["info", format ["Broadcasting UAV %1 via MAVLink mock to %2", _callsign, player getVariable [QEGVAR(client,mavlink_address), ""]]]]];
|
||||||
|
};
|
||||||
|
|
||||||
|
_uav setVariable ["armatak_uav_mavlink_broadcasting", true, true];
|
||||||
|
|
||||||
|
private _mavlinkAddress = player getVariable [QEGVAR(client,mavlink_address), ""];
|
||||||
|
if (_mavlinkAddress isEqualTo "") exitWith {};
|
||||||
|
|
||||||
|
private _pos = [_uav] call EFUNC(client,extractClientPosition);
|
||||||
|
private _relAlt = ((getPosATL _uav) select 2) max 0;
|
||||||
|
if (isNil {_uav getVariable "armatak_uas_home_atl"}) then {
|
||||||
|
_uav setVariable ["armatak_uas_home_atl", getPosATL _uav, true];
|
||||||
|
_uav setVariable ["armatak_uas_home_geo", [_pos select 1, _pos select 2, (_pos select 3) - _relAlt], true];
|
||||||
|
};
|
||||||
|
private _uuid = [_uav] call armatak_fnc_extract_uuid;
|
||||||
|
private _callsign = [_uav] call armatak_fnc_extract_marker_callsign;
|
||||||
|
private _videoUri = [_uav] call FUNC(resolveVideoUri);
|
||||||
|
private _dir = vectorDir _uav;
|
||||||
|
private _up = vectorUp _uav;
|
||||||
|
private _yaw = getDir _uav;
|
||||||
|
private _pitch = asin (((_dir select 2) max -1) min 1);
|
||||||
|
private _roll = asin (((_up select 0) max -1) min 1);
|
||||||
|
private _uavType = if (_uav isKindOf "Plane") then {1} else {[2, 3] select (_uav isKindOf "Helicopter")};
|
||||||
|
private _armed = _uav getVariable ["armatak_uas_armed", isEngineOn _uav];
|
||||||
|
if !(isEngineOn _uav) then {
|
||||||
|
_armed = false;
|
||||||
|
_uav setVariable ["armatak_uas_armed", false, true];
|
||||||
|
};
|
||||||
|
private _groundSpeed = abs (_pos select 6);
|
||||||
|
private _landed = (_relAlt <= 1.5) && {_groundSpeed <= 0.5};
|
||||||
|
private _batteryRemaining = round ((((fuel _uav) max 0) min 1) * 100);
|
||||||
|
|
||||||
|
private _gimbalRoll = 0;
|
||||||
|
private _gimbalPitch = _pitch;
|
||||||
|
private _gimbalYaw = _yaw;
|
||||||
|
private _hfov = _uav getVariable ["armatak_uas_fov", 60];
|
||||||
|
private _vfov = _uav getVariable ["armatak_uas_vfov", (_hfov * 0.5625)];
|
||||||
|
private _imageLat = _pos select 1;
|
||||||
|
private _imageLon = _pos select 2;
|
||||||
|
private _imageAlt = _pos select 3;
|
||||||
|
private _cameraData = [_uav, "turret"] call armatak_fnc_extract_uas_camera_data;
|
||||||
|
private _uavControl = UAVControl _uav;
|
||||||
|
private _controlledTurretPath = _uavControl param [1, []];
|
||||||
|
private _hasTurretCamera = ((_controlledTurretPath isEqualType []) && {_controlledTurretPath isNotEqualTo []}) || {(allTurrets _uav) isNotEqualTo []};
|
||||||
|
|
||||||
|
if (_cameraData isEqualType [] && {(count _cameraData) >= 6}) then {
|
||||||
|
_gimbalYaw = _cameraData param [0, _yaw];
|
||||||
|
_gimbalPitch = _cameraData param [1, _pitch];
|
||||||
|
_hfov = _cameraData param [2, _hfov];
|
||||||
|
_vfov = _uav getVariable ["armatak_uas_vfov", (_hfov * 0.5625)];
|
||||||
|
|
||||||
|
private _spiGeo = _cameraData param [5, []];
|
||||||
|
if (_spiGeo isEqualType [] && {(count _spiGeo) >= 3}) then {
|
||||||
|
_imageLat = _spiGeo select 0;
|
||||||
|
_imageLon = _spiGeo select 1;
|
||||||
|
_imageAlt = _spiGeo select 2;
|
||||||
|
};
|
||||||
|
};
|
||||||
|
|
||||||
|
private _systemPayload = [
|
||||||
|
_mavlinkAddress,
|
||||||
|
_uuid,
|
||||||
|
_callsign,
|
||||||
|
_uavType,
|
||||||
|
_pos select 1,
|
||||||
|
_pos select 2,
|
||||||
|
_pos select 3,
|
||||||
|
_relAlt,
|
||||||
|
_pos select 5,
|
||||||
|
_pos select 6,
|
||||||
|
_roll,
|
||||||
|
_pitch,
|
||||||
|
_yaw,
|
||||||
|
parseNumber _armed,
|
||||||
|
parseNumber _landed,
|
||||||
|
_gimbalRoll,
|
||||||
|
_gimbalPitch,
|
||||||
|
_gimbalYaw,
|
||||||
|
_videoUri,
|
||||||
|
_hfov,
|
||||||
|
_vfov,
|
||||||
|
_imageLat,
|
||||||
|
_imageLon,
|
||||||
|
_imageAlt,
|
||||||
|
parseNumber _hasTurretCamera,
|
||||||
|
_batteryRemaining
|
||||||
|
];
|
||||||
|
|
||||||
|
"armatak" callExtension ["uas:send_uas_system", [_systemPayload]];
|
||||||
@@ -1,17 +1,17 @@
|
|||||||
#define COMPONENT video
|
#define COMPONENT uav
|
||||||
#define COMPONENT_BEAUTIFIED Video Streaming
|
#define COMPONENT_BEAUTIFIED UAV
|
||||||
#include "\armatak\armatak\addons\main\script_mod.hpp"
|
#include "\armatak\armatak\addons\main\script_mod.hpp"
|
||||||
|
|
||||||
// #define DEBUG_MODE_FULL
|
// #define DEBUG_MODE_FULL
|
||||||
// #define DISABLE_COMPILE_CACHE
|
// #define DISABLE_COMPILE_CACHE
|
||||||
// #define ENABLE_PERFORMANCE_COUNTERS
|
// #define ENABLE_PERFORMANCE_COUNTERS
|
||||||
|
|
||||||
#ifdef DEBUG_ENABLED_MAIN
|
#ifdef DEBUG_ENABLED_UAV
|
||||||
#define DEBUG_MODE_FULL
|
#define DEBUG_MODE_FULL
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#ifdef DEBUG_SETTINGS_MAIN
|
#ifdef DEBUG_SETTINGS_UAV
|
||||||
#define DEBUG_SETTINGS DEBUG_SETTINGS_MAIN
|
#define DEBUG_SETTINGS DEBUG_SETTINGS_UAV
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
#include "\z\ace\addons\main\script_macros.hpp"
|
#include "\z\ace\addons\main\script_macros.hpp"
|
||||||
@@ -1 +0,0 @@
|
|||||||
armatak\armatak\addons\video
|
|
||||||
@@ -1,73 +0,0 @@
|
|||||||
class CfgVehicles {
|
|
||||||
class Logic;
|
|
||||||
|
|
||||||
class Module_F : Logic
|
|
||||||
{
|
|
||||||
class AttributesBase
|
|
||||||
{
|
|
||||||
class Default;
|
|
||||||
class Edit;
|
|
||||||
class Combo;
|
|
||||||
class Checkbox;
|
|
||||||
class CheckboxNumber;
|
|
||||||
class ModuleDescription;
|
|
||||||
class Units;
|
|
||||||
};
|
|
||||||
|
|
||||||
class ModuleDescription
|
|
||||||
{
|
|
||||||
class AnyBrain;
|
|
||||||
};
|
|
||||||
};
|
|
||||||
class EGVAR(server,moduleBase);
|
|
||||||
class GVAR(videoModule): EGVAR(server,moduleBase) {
|
|
||||||
scope = 2;
|
|
||||||
scopeCurator = 0;
|
|
||||||
displayname = "Video Streaming Handler";
|
|
||||||
icon = "\a3\Modules_F_Curator\Data\iconRadio_ca.paa";
|
|
||||||
category = QEGVAR(main,moduleCategory);
|
|
||||||
function = QFUNC(videoParser);
|
|
||||||
functionPriority = 1;
|
|
||||||
isGlobal = 0;
|
|
||||||
isTriggerActivated = 1;
|
|
||||||
isDisposable = 1;
|
|
||||||
is3den = 0;
|
|
||||||
curatorCanAttach = 0;
|
|
||||||
curatorInfoType = "RscDisplayAttributeModuleNuke";
|
|
||||||
canSetArea = 0;
|
|
||||||
canSetAreaShape = 0;
|
|
||||||
canSetAreaHeight = 0;
|
|
||||||
/*
|
|
||||||
class Attributes: AttributesBase {
|
|
||||||
class GVAR(instanceAddress): Edit {
|
|
||||||
property = QGVAR(instanceAddress);
|
|
||||||
displayname = "MediaMTX Provider Address";
|
|
||||||
tooltip = "MediaMTX Provider Instance Address";
|
|
||||||
typeName = "STRING";
|
|
||||||
defaultValue = "localhost";
|
|
||||||
};
|
|
||||||
class GVAR(instancePort): Edit {
|
|
||||||
property = QGVAR(instancePort);
|
|
||||||
displayname = QUOTE(MediaMTX Provider Port);
|
|
||||||
tooltip = QUOTE(MediaMTX Provider Port for handling video streams);
|
|
||||||
typeName = "STRING";
|
|
||||||
defaultValue = "8554";
|
|
||||||
};
|
|
||||||
class GVAR(instanceAuthUser): Edit {
|
|
||||||
property = QGVAR(instanceAuthUser);
|
|
||||||
displayname = QUOTE(MediaMTX Provider Username);
|
|
||||||
tooltip = QUOTE(MediaMTX Provider Instance Username);
|
|
||||||
typeName = "STRING";
|
|
||||||
defaultValue = "administrator";
|
|
||||||
};
|
|
||||||
class GVAR(instanceAuthPassword): Edit {
|
|
||||||
property = QGVAR(instanceAuthPassword);
|
|
||||||
displayname = QUOTE(MediaMTX Provider Password);
|
|
||||||
tooltip = QUOTE(MediaMTX Provider Instance Password);
|
|
||||||
typeName = "STRING";
|
|
||||||
defaultValue = "password";
|
|
||||||
};
|
|
||||||
};
|
|
||||||
*/
|
|
||||||
};
|
|
||||||
};
|
|
||||||
@@ -1 +0,0 @@
|
|||||||
PREP(videoParser);
|
|
||||||
@@ -1,83 +0,0 @@
|
|||||||
#include "..\script_component.hpp"
|
|
||||||
|
|
||||||
params [
|
|
||||||
["_logic", objNull, [objNull]],
|
|
||||||
["_units", [], [[]]],
|
|
||||||
["_activated", true, [true]]
|
|
||||||
];
|
|
||||||
|
|
||||||
if (isServer) exitWith {
|
|
||||||
private _instance_address = GETVAR(_logic,GVAR(instanceAddress),false);
|
|
||||||
private _instance_port = GETVAR(_logic,GVAR(instancePort),false);
|
|
||||||
private _instance_auth_user = GETVAR(_logic,GVAR(instanceAuthUser),false);
|
|
||||||
private _instance_auth_pass = GETVAR(_logic,GVAR(instanceAuthPassword),false);
|
|
||||||
|
|
||||||
SETMVAR(GVAR(instanceAddress),_instance_address);
|
|
||||||
SETMVAR(GVAR(instancePort),_instance_port);
|
|
||||||
SETMVAR(GVAR(instanceAuthUser),_instance_auth_user);
|
|
||||||
SETMVAR(GVAR(instanceAuthPassword),_instance_auth_pass);
|
|
||||||
|
|
||||||
_startAction = [
|
|
||||||
QGVAR(startStream),
|
|
||||||
"Start Video Feed",
|
|
||||||
"",
|
|
||||||
{
|
|
||||||
_uuid = (_this select 0) call armatak_fnc_extract_uuid;
|
|
||||||
_uuid_short = _uuid select [0, 8];
|
|
||||||
_role = roleDescription (_this select 0);
|
|
||||||
_name = name (_this select 0);
|
|
||||||
|
|
||||||
_role = [_role] call BIS_fnc_filterString;
|
|
||||||
_name = [_name] call BIS_fnc_filterString;
|
|
||||||
|
|
||||||
_stream_path = _name + "_" + _role + "_" + _uuid_short;
|
|
||||||
|
|
||||||
armatak_mediamtx_video_stream_instance_address = GETMVAR(instance_address,false);
|
|
||||||
armatak_mediamtx_video_stream_instance_port = missionNamespace getVariable "instance_port";
|
|
||||||
armatak_mediamtx_video_stream_instance_auth_user = missionNamespace getVariable "instance_auth_user";
|
|
||||||
armatak_mediamtx_video_stream_instance_auth_pass = missionNamespace getVariable "instance_auth_pass";
|
|
||||||
|
|
||||||
"armatak" callExtension ["video_stream:start", [armatak_mediamtx_video_stream_instance_address, armatak_mediamtx_video_stream_instance_port, _stream_path, armatak_mediamtx_video_stream_instance_auth_user, armatak_mediamtx_video_stream_instance_auth_pass]];
|
|
||||||
(_this select 0) setVariable ["armatak_video_feed_is_streaming", true];
|
|
||||||
},
|
|
||||||
{
|
|
||||||
(_this select 0) getVariable "armatak_video_feed_is_streaming" == false
|
|
||||||
}
|
|
||||||
] call ace_interact_menu_fnc_createAction;
|
|
||||||
[
|
|
||||||
"Man",
|
|
||||||
1,
|
|
||||||
["ACE_SelfActions"],
|
|
||||||
_startAction,
|
|
||||||
true
|
|
||||||
] call ace_interact_menu_fnc_addActionToClass;
|
|
||||||
|
|
||||||
_stopAction = [
|
|
||||||
"ArmatakStopStream",
|
|
||||||
"Stop Video Feed",
|
|
||||||
"",
|
|
||||||
{
|
|
||||||
"armatak" callExtension ["video_stream:stop", []];
|
|
||||||
SETVAR(_this select 0,GVAR(isStreaming),false);
|
|
||||||
},
|
|
||||||
{
|
|
||||||
GETVAR((this select 0),GVAR(isStreaming),false)
|
|
||||||
}
|
|
||||||
] call ace_interact_menu_fnc_createAction;
|
|
||||||
[
|
|
||||||
"Man",
|
|
||||||
1,
|
|
||||||
["ACE_SelfActions"],
|
|
||||||
_stopAction,
|
|
||||||
true
|
|
||||||
] call ace_interact_menu_fnc_addActionToClass;
|
|
||||||
if (isMultiplayer) then {
|
|
||||||
{
|
|
||||||
SETVAR(_x,GVAR(isStreaming),false);
|
|
||||||
} forEach playableUnits;
|
|
||||||
} else {
|
|
||||||
SETVAR(player,GVAR(isStreaming),false);
|
|
||||||
};
|
|
||||||
};
|
|
||||||
|
|
||||||
true;
|
|
||||||
@@ -0,0 +1,188 @@
|
|||||||
|
# TAK authentication flows
|
||||||
|
|
||||||
|
This document describes the authentication and transport flows implemented by the ArmaTAK Rust extension. It is development documentation, not end-user documentation.
|
||||||
|
|
||||||
|
## Security model
|
||||||
|
|
||||||
|
ArmaTAK currently exposes three TCP connection modes:
|
||||||
|
|
||||||
|
| Mode | ArmaTAK entry point | Authentication | Transport protection | Intended use |
|
||||||
|
| --- | --- | --- | --- | --- |
|
||||||
|
| Plain TCP | `tcp_socket.start` | None | None | Local development or explicitly trusted isolated networks only |
|
||||||
|
| Manual mTLS | `tcp_socket.start_mtls` | Client X.509 certificate | TLS with server certificate validation | Production-compatible secure connection |
|
||||||
|
| Credential enrollment followed by mTLS | `tcp_socket.start_enroll_mtls` | HTTP Basic credentials during enrollment, then client X.509 certificate | Enrollment HTTPS currently skips certificate validation; the resulting TAK stream uses validated mTLS | Transitional/bootstrap flow; do not treat the enrollment phase as secure until server verification is enabled |
|
||||||
|
|
||||||
|
The official TAK Server example enables a TLS input on port `8089`. Its plaintext TCP/streaming examples are anonymous and are shown on ports `8087` and `8088`. ArmaTAK must not infer security from a port number; the selected connection mode controls the client-side security properties.
|
||||||
|
|
||||||
|
## Insecure flow: plain TCP
|
||||||
|
|
||||||
|
The plain flow is deliberately simple:
|
||||||
|
|
||||||
|
```text
|
||||||
|
Arma/SQF
|
||||||
|
|
|
||||||
|
| tcp_socket.start("host:port")
|
||||||
|
v
|
||||||
|
ConnectionConfig::Plain
|
||||||
|
|
|
||||||
|
v
|
||||||
|
TCP connect
|
||||||
|
|
|
||||||
|
| unencrypted CoT bytes
|
||||||
|
v
|
||||||
|
TAK Server plaintext/anonymous input
|
||||||
|
```
|
||||||
|
|
||||||
|
`ConnectionConfig::Plain` resolves the supplied address and opens a normal `TcpStream`. No TLS handshake occurs, there is no server identity verification, and no client identity is established by ArmaTAK.
|
||||||
|
|
||||||
|
Consequences:
|
||||||
|
|
||||||
|
- CoT payloads can be observed or modified by an on-path attacker.
|
||||||
|
- ArmaTAK cannot prove that it connected to the intended TAK Server.
|
||||||
|
- The server cannot authenticate ArmaTAK by certificate.
|
||||||
|
- Plain TCP must never be the production default.
|
||||||
|
|
||||||
|
The official TAK Server `CoreConfig.example.xml` keeps anonymous TCP inputs commented out and enables the TLS input instead. Use plain TCP only when a developer intentionally configures a corresponding non-TLS server input.
|
||||||
|
|
||||||
|
## Secure flow: manual mTLS
|
||||||
|
|
||||||
|
The manual mTLS flow uses pre-provisioned certificate material:
|
||||||
|
|
||||||
|
```text
|
||||||
|
Arma/SQF
|
||||||
|
|
|
||||||
|
| tcp_socket.start_mtls(
|
||||||
|
| address,
|
||||||
|
| server_name,
|
||||||
|
| ca_cert_path,
|
||||||
|
| client_cert_path,
|
||||||
|
| client_key_path
|
||||||
|
| )
|
||||||
|
v
|
||||||
|
ConnectionConfig::Mtls
|
||||||
|
|
|
||||||
|
+--> load trusted CA certificate(s)
|
||||||
|
+--> load client certificate chain
|
||||||
|
+--> load client private key
|
||||||
|
|
|
||||||
|
v
|
||||||
|
rustls client configuration
|
||||||
|
|
|
||||||
|
+--> validate server certificate chain
|
||||||
|
+--> validate TLS server name
|
||||||
|
+--> present client certificate
|
||||||
|
v
|
||||||
|
Authenticated mTLS TAK stream
|
||||||
|
```
|
||||||
|
|
||||||
|
The CA file is loaded into a dedicated `rustls::RootCertStore`; the client certificate and private key are used for client authentication. When `server_name` is empty, ArmaTAK derives a name from the target address. A non-empty `server_name` should be preferred when DNS and certificate names are known.
|
||||||
|
|
||||||
|
This is the preferred production flow when certificate provisioning is handled outside ArmaTAK.
|
||||||
|
|
||||||
|
## Enrollment flow: credentials to client certificate
|
||||||
|
|
||||||
|
TAK enrollment converts a username/password bootstrap credential into a short- or medium-lived client certificate, then reconnects using mTLS.
|
||||||
|
|
||||||
|
### Protocol contract
|
||||||
|
|
||||||
|
ArmaTAK follows the contract visible in the official TAK Server and ATAK implementations:
|
||||||
|
|
||||||
|
1. `GET https://HOST:ENROLL_PORT/Marti/api/tls/config`
|
||||||
|
2. Authenticate the request with HTTP Basic credentials.
|
||||||
|
3. Read `serverPort` and `enrollPath` from the TAK certificate configuration. If the fields are absent, ArmaTAK currently falls back to `8089` and `/Marti/api/tls/signClient/v2`.
|
||||||
|
4. Generate a local RSA key pair and PKCS#10 CSR. The private key never needs to be sent to the server.
|
||||||
|
5. `POST https://HOST:ENROLL_PORT{enrollPath}?clientUid=CLIENT_UID`
|
||||||
|
6. Authenticate the signing request with HTTP Basic credentials, send the CSR as `application/pkcs10`, and request JSON.
|
||||||
|
7. Parse `signedCert` and `ca0` from the enrollment response.
|
||||||
|
8. Build an in-memory client identity from the returned certificate plus the locally generated private key.
|
||||||
|
9. Connect to `HOST:serverPort` with mTLS and validate the TAK streaming server against the returned CA.
|
||||||
|
|
||||||
|
The official TAK Server exposes `/tls/config`, `/tls/signClient`, and `/tls/signClient/v2`. The v2 endpoint can return JSON containing `signedCert` plus `ca0`, `ca1`, and additional CA-chain entries. The current ArmaTAK implementation consumes `signedCert` and `ca0`.
|
||||||
|
|
||||||
|
### Current ArmaTAK enrollment security caveat
|
||||||
|
|
||||||
|
`enrollment_http_client()` currently uses `danger_accept_invalid_certs(true)`. Therefore the HTTPS bootstrap does **not** authenticate the enrollment server certificate.
|
||||||
|
|
||||||
|
That means the current enrollment phase is vulnerable to an active man-in-the-middle attacker who can impersonate the HTTPS enrollment endpoint and receive the submitted Basic credentials. The private key remains local, but the username/password bootstrap secret is still exposed to the impersonating endpoint.
|
||||||
|
|
||||||
|
The connection established *after* enrollment is mTLS and uses the returned CA, but that does not retroactively secure the bootstrap exchange. Consequently:
|
||||||
|
|
||||||
|
- `start_enroll_mtls` is a transitional flow, not the preferred production-secure flow in its current form.
|
||||||
|
- `start_mtls` with a trusted CA and pre-provisioned client certificate is the secure production path today.
|
||||||
|
- A future secure enrollment implementation must validate the HTTPS server with a trusted CA, certificate pin, or equivalent authenticated trust bootstrap.
|
||||||
|
- An explicit insecure/development enrollment switch is preferable to silently disabling verification.
|
||||||
|
|
||||||
|
The official ATAK enrollment manager exposes a `verifyHost` choice and records whether host verification is on or off. ArmaTAK should converge on the same explicit distinction.
|
||||||
|
|
||||||
|
## Target secure enrollment design
|
||||||
|
|
||||||
|
The intended production enrollment flow is:
|
||||||
|
|
||||||
|
```text
|
||||||
|
username/password
|
||||||
|
|
|
||||||
|
v
|
||||||
|
HTTPS enrollment endpoint
|
||||||
|
(server certificate MUST validate)
|
||||||
|
|
|
||||||
|
+--> GET /Marti/api/tls/config
|
||||||
|
+--> generate local private key + CSR
|
||||||
|
+--> POST configured signClient endpoint
|
||||||
|
v
|
||||||
|
signed client certificate + trusted CA
|
||||||
|
|
|
||||||
|
v
|
||||||
|
mTLS TAK streaming connection
|
||||||
|
|
|
||||||
|
+--> server authenticated by CA/name
|
||||||
|
+--> client authenticated by certificate
|
||||||
|
v
|
||||||
|
CoT traffic
|
||||||
|
```
|
||||||
|
|
||||||
|
The development-only insecure variant should be explicit:
|
||||||
|
|
||||||
|
```text
|
||||||
|
username/password
|
||||||
|
|
|
||||||
|
v
|
||||||
|
HTTPS enrollment endpoint
|
||||||
|
(certificate verification explicitly disabled)
|
||||||
|
|
|
||||||
|
v
|
||||||
|
WARNING / development-only path
|
||||||
|
```
|
||||||
|
|
||||||
|
Do not silently fall back from verified enrollment to unverified enrollment after a certificate validation failure.
|
||||||
|
|
||||||
|
## Secret-handling requirements
|
||||||
|
|
||||||
|
- Never include passwords, private keys, certificate payloads, or Authorization headers in logs.
|
||||||
|
- `ConnectionConfig::describe()` may include the username and client UID for diagnostics, but it must never include the password.
|
||||||
|
- Keep generated private keys in memory unless a future feature explicitly requires persistence.
|
||||||
|
- Do not commit development certificates or credentials to the repository.
|
||||||
|
- Treat enrollment credentials as bootstrap secrets and rotate/revoke them according to the TAK Server deployment policy.
|
||||||
|
|
||||||
|
## Test contract
|
||||||
|
|
||||||
|
Unit tests should lock down the protocol-level behavior that does not require a live TAK Server:
|
||||||
|
|
||||||
|
- official endpoint paths and default mTLS port;
|
||||||
|
- trimming and construction of enrollment URLs;
|
||||||
|
- parsing TAK enrollment configuration with explicit values and fallback defaults;
|
||||||
|
- PEM normalization;
|
||||||
|
- absence of passwords from diagnostic descriptions;
|
||||||
|
- TLS server-name derivation and PEM parsing where deterministic;
|
||||||
|
- CoT and MAVLink pure serialization logic.
|
||||||
|
|
||||||
|
Live certificate signing, TLS handshake behavior, socket reconnect behavior, mDNS, video processes, and Arma callback behavior belong in integration/E2E tests because they depend on operating-system or external-server state.
|
||||||
|
|
||||||
|
## Upstream references
|
||||||
|
|
||||||
|
The tests and protocol assumptions in this repository are based on these upstream implementations:
|
||||||
|
|
||||||
|
- TAK Server, `CertManagerApi.java`: <https://github.com/TAK-Product-Center/Server/blob/5187abd46d827d37cfc5708805eced197a837e49/src/takserver-core/takserver-war/src/main/java/com/bbn/tak/tls/CertManagerApi.java>
|
||||||
|
- TAK Server, `CoreConfig.example.xml`: <https://github.com/TAK-Product-Center/Server/blob/5187abd46d827d37cfc5708805eced197a837e49/src/takserver-core/example/CoreConfig.example.xml>
|
||||||
|
- ATAK/CommonCommo, `enrollmentmanager.cpp`: <https://github.com/TAK-Product-Center/atak-civ/blob/9f6893dd657feacc35ec5de03dad721c2e44170e/commoncommo/core/impl/enrollmentmanager.cpp>
|
||||||
|
|
||||||
|
Pinning the source revisions in this document keeps the development contract reproducible. When the upstream protocol changes, update both the implementation/tests and these references together.
|
||||||
@@ -0,0 +1,83 @@
|
|||||||
|
# Rust testing and coverage policy
|
||||||
|
|
||||||
|
This document defines the development-time testing and coverage policy for the ArmaTAK Rust extension.
|
||||||
|
|
||||||
|
## Goals
|
||||||
|
|
||||||
|
The CI pipeline has two complementary coverage goals:
|
||||||
|
|
||||||
|
1. **100% line coverage for deterministic unit-testable code.** Pure protocol parsing, serialization, value normalization, packet construction, configuration descriptions, and other deterministic helpers belong in this gate.
|
||||||
|
2. **A non-regression floor for the complete Rust extension.** The complete report includes network adapters, mDNS, process management, Arma callbacks, socket loops, and TLS handshakes even when those components require integration or E2E infrastructure rather than unit tests.
|
||||||
|
|
||||||
|
The first goal prevents newly added deterministic logic from bypassing unit tests. The second prevents the overall extension from silently losing coverage while integration coverage is expanded.
|
||||||
|
|
||||||
|
## Local commands
|
||||||
|
|
||||||
|
Run the complete Rust unit test suite with:
|
||||||
|
|
||||||
|
```bash
|
||||||
|
cargo test --all-targets --locked
|
||||||
|
```
|
||||||
|
|
||||||
|
Install `cargo-llvm-cov` and inspect line coverage with:
|
||||||
|
|
||||||
|
```bash
|
||||||
|
cargo llvm-cov --all-targets --locked --summary-only
|
||||||
|
```
|
||||||
|
|
||||||
|
Generate an LCOV file with:
|
||||||
|
|
||||||
|
```bash
|
||||||
|
cargo llvm-cov --all-targets --locked --lcov --output-path lcov.info
|
||||||
|
```
|
||||||
|
|
||||||
|
CI publishes `lcov.info` as the `rust-lcov` artifact after a successful run.
|
||||||
|
|
||||||
|
## What belongs in the 100% unit gate
|
||||||
|
|
||||||
|
A source file should be included in the deterministic 100% gate when its behavior can be exercised without relying on:
|
||||||
|
|
||||||
|
- a live TAK Server;
|
||||||
|
- a live ATAK client;
|
||||||
|
- an operating-system socket peer;
|
||||||
|
- mDNS availability;
|
||||||
|
- an FFmpeg or external video process;
|
||||||
|
- timing-sensitive reconnect loops;
|
||||||
|
- Arma engine callback scheduling;
|
||||||
|
- real certificate enrollment or a real TLS handshake.
|
||||||
|
|
||||||
|
Examples include TAK enrollment URL/config parsing, XML serialization, MAVLink checksums and identity derivation, payload conversion, and diagnostic formatting.
|
||||||
|
|
||||||
|
When adding deterministic production code, add the tests in the same change. If a previously excluded file becomes fully unit-testable, bring it to 100% line coverage and remove it from the CI exclusion expression.
|
||||||
|
|
||||||
|
## What does not belong in a unit-only 100% gate
|
||||||
|
|
||||||
|
External adapters are still part of the full-extension coverage report, but forcing them into a unit-only percentage usually produces brittle or misleading tests. The following behavior should be verified through integration or E2E fixtures instead:
|
||||||
|
|
||||||
|
- TCP/UDP connection establishment and reconnect behavior;
|
||||||
|
- TAK Server certificate enrollment over HTTPS;
|
||||||
|
- real mTLS certificate-chain and server-name verification;
|
||||||
|
- mDNS publication/discovery;
|
||||||
|
- subprocess lifecycle and video streaming;
|
||||||
|
- Arma engine callback delivery and long-running endpoint threads.
|
||||||
|
|
||||||
|
These components must not be hidden from the complete report. Their zero or partial unit coverage remains visible and therefore continues to affect the global non-regression floor.
|
||||||
|
|
||||||
|
## Authentication test contract
|
||||||
|
|
||||||
|
Authentication protocol assumptions are derived from pinned official upstream implementations. See [authentication-flows.md](authentication-flows.md) for the exact TAK Server and ATAK source revisions.
|
||||||
|
|
||||||
|
At minimum, unit tests lock down:
|
||||||
|
|
||||||
|
- `/Marti/api/tls/config` construction;
|
||||||
|
- the v2 `signClient` enrollment path and the official `8089` mTLS default;
|
||||||
|
- Basic-auth enrollment configuration behavior at the adapter boundary;
|
||||||
|
- enrollment XML parsing, including missing and malformed tags;
|
||||||
|
- PEM normalization;
|
||||||
|
- the rule that diagnostic descriptions never contain enrollment passwords.
|
||||||
|
|
||||||
|
A future verified-enrollment implementation must add tests for the trust-bootstrap configuration and integration tests using a real or fixture TLS server. It must never silently downgrade from verified HTTPS to disabled certificate validation.
|
||||||
|
|
||||||
|
## Coverage changes
|
||||||
|
|
||||||
|
Coverage thresholds are intentionally enforced in CI rather than documented as aspirational numbers. When a change increases the complete-extension baseline, raise the global floor in the workflow in the same pull request or branch before merging. Do not lower either coverage threshold merely to make CI pass; lower thresholds only when a documented architectural change makes the previous metric invalid.
|
||||||
+91
-2
@@ -1,3 +1,4 @@
|
|||||||
|
use super::video::video_detail_xml;
|
||||||
use chrono::{Duration, SecondsFormat, Utc};
|
use chrono::{Duration, SecondsFormat, Utc};
|
||||||
use uuid::Uuid;
|
use uuid::Uuid;
|
||||||
|
|
||||||
@@ -16,6 +17,8 @@ pub struct CursorOverTime {
|
|||||||
pub track_speed: Option<f32>,
|
pub track_speed: Option<f32>,
|
||||||
pub link_uid: Option<String>,
|
pub link_uid: Option<String>,
|
||||||
pub remarker: Option<String>,
|
pub remarker: Option<String>,
|
||||||
|
pub video_url: Option<String>,
|
||||||
|
pub stale_seconds: Option<i64>,
|
||||||
}
|
}
|
||||||
|
|
||||||
impl CursorOverTime {
|
impl CursorOverTime {
|
||||||
@@ -32,8 +35,9 @@ impl CursorOverTime {
|
|||||||
|
|
||||||
let created_time = Utc::now().to_rfc3339_opts(SecondsFormat::Millis, true);
|
let created_time = Utc::now().to_rfc3339_opts(SecondsFormat::Millis, true);
|
||||||
|
|
||||||
let stale_time =
|
let stale_seconds = self.stale_seconds.unwrap_or(360).max(1);
|
||||||
(Utc::now() + Duration::seconds(360)).to_rfc3339_opts(SecondsFormat::Millis, true);
|
let stale_time = (Utc::now() + Duration::seconds(stale_seconds))
|
||||||
|
.to_rfc3339_opts(SecondsFormat::Millis, true);
|
||||||
|
|
||||||
let mut xml = String::new();
|
let mut xml = String::new();
|
||||||
|
|
||||||
@@ -107,8 +111,93 @@ impl CursorOverTime {
|
|||||||
xml.push_str(format!("<remarks>ARMATAK | {}</remarks>", remark).as_str());
|
xml.push_str(format!("<remarks>ARMATAK | {}</remarks>", remark).as_str());
|
||||||
}
|
}
|
||||||
|
|
||||||
|
if let Some(video_url) = &self.video_url {
|
||||||
|
if !video_url.trim().is_empty() {
|
||||||
|
xml.push_str(&video_detail_xml(video_url, uuid, &self.contact_callsign));
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
xml.push_str("</detail></event>");
|
xml.push_str("</detail></event>");
|
||||||
|
|
||||||
return xml;
|
return xml;
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#[cfg(test)]
|
||||||
|
mod tests {
|
||||||
|
use super::CursorOverTime;
|
||||||
|
|
||||||
|
fn minimal_marker() -> CursorOverTime {
|
||||||
|
CursorOverTime {
|
||||||
|
uuid: None,
|
||||||
|
r#type: None,
|
||||||
|
point_lat: -30.0,
|
||||||
|
point_lon: -51.0,
|
||||||
|
point_hae: 10.0,
|
||||||
|
point_ce: None,
|
||||||
|
point_le: None,
|
||||||
|
contact_callsign: "Falcon".to_string(),
|
||||||
|
group_name: None,
|
||||||
|
group_role: None,
|
||||||
|
track_course: None,
|
||||||
|
track_speed: None,
|
||||||
|
link_uid: None,
|
||||||
|
remarker: None,
|
||||||
|
video_url: None,
|
||||||
|
stale_seconds: None,
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn serializes_minimal_marker_with_tak_defaults() {
|
||||||
|
let xml = minimal_marker().convert_to_xml();
|
||||||
|
|
||||||
|
assert!(xml.starts_with("<?xml version=\"1.0\" encoding=\"UTF-8\" ?>"));
|
||||||
|
assert!(xml.contains("<event type=\"a-f-G-U-C-I\" version=\"2.0\""));
|
||||||
|
assert!(xml.contains("<point ce=\"9999999\" le=\"9999999\" hae=\"10\" lat=\"-30\" lon=\"-51\" />"));
|
||||||
|
assert!(xml.contains("<contact callsign=\"Falcon\" />"));
|
||||||
|
assert!(xml.contains("<uid Droid=\"Falcon\"/>"));
|
||||||
|
assert!(!xml.contains("<link "));
|
||||||
|
assert!(!xml.contains("<track "));
|
||||||
|
assert!(!xml.contains("<__group "));
|
||||||
|
assert!(!xml.contains("<remarks>"));
|
||||||
|
assert!(!xml.contains("<__video>"));
|
||||||
|
assert!(xml.ends_with("</detail></event>"));
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn serializes_all_optional_marker_details() {
|
||||||
|
let marker = CursorOverTime {
|
||||||
|
uuid: Some("marker-1".to_string()),
|
||||||
|
r#type: Some("a-f-G-U-C".to_string()),
|
||||||
|
point_lat: 1.25,
|
||||||
|
point_lon: 2.5,
|
||||||
|
point_hae: 100.0,
|
||||||
|
point_ce: Some(3.0),
|
||||||
|
point_le: Some(4.0),
|
||||||
|
contact_callsign: "Raven".to_string(),
|
||||||
|
group_name: Some("Cyan".to_string()),
|
||||||
|
group_role: Some("Team Member".to_string()),
|
||||||
|
track_course: Some(180),
|
||||||
|
track_speed: Some(12.5),
|
||||||
|
link_uid: Some("parent-1".to_string()),
|
||||||
|
remarker: Some("test remark".to_string()),
|
||||||
|
video_url: Some("rtsp://video.example.test:8554/live".to_string()),
|
||||||
|
stale_seconds: Some(0),
|
||||||
|
};
|
||||||
|
|
||||||
|
let xml = marker.convert_to_xml();
|
||||||
|
|
||||||
|
assert!(xml.contains("type=\"a-f-G-U-C\""));
|
||||||
|
assert!(xml.contains("uid=\"marker-1\""));
|
||||||
|
assert!(xml.contains("<point ce=\"3\" le=\"4\" hae=\"100\" lat=\"1.25\" lon=\"2.5\" />"));
|
||||||
|
assert!(xml.contains("<precisionlocation altsrc=\"DTED0\" />"));
|
||||||
|
assert!(xml.contains("<link uid=\"parent-1\" type=\"a-f-G-U-C\" relation=\"p-p\" />"));
|
||||||
|
assert!(xml.contains("<hideLabel />"));
|
||||||
|
assert!(xml.contains("<track course=\"180\" speed=\"12.5\" />"));
|
||||||
|
assert!(xml.contains("<status battery=\"89\" />"));
|
||||||
|
assert!(xml.contains("<__group name=\"Cyan\" role=\"Team Member\" />"));
|
||||||
|
assert!(xml.contains("<remarks>ARMATAK | test remark</remarks>"));
|
||||||
|
assert!(xml.contains("<ConnectionEntry protocol=\"rtsp\""));
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|||||||
@@ -0,0 +1,74 @@
|
|||||||
|
use arma_rs::{FromArma, FromArmaError};
|
||||||
|
use chrono::{Duration, SecondsFormat, Utc};
|
||||||
|
|
||||||
|
pub struct DeleteCoTPayload {
|
||||||
|
pub target_uid: String,
|
||||||
|
pub target_type: String,
|
||||||
|
pub point_lat: f64,
|
||||||
|
pub point_lon: f64,
|
||||||
|
pub point_hae: f32,
|
||||||
|
}
|
||||||
|
|
||||||
|
impl FromArma for DeleteCoTPayload {
|
||||||
|
fn from_arma(data: String) -> Result<DeleteCoTPayload, FromArmaError> {
|
||||||
|
let (target_uid, target_type, point_lat, point_lon, point_hae) =
|
||||||
|
<(String, String, f64, f64, f32)>::from_arma(data)?;
|
||||||
|
Ok(Self {
|
||||||
|
target_uid,
|
||||||
|
target_type,
|
||||||
|
point_lat,
|
||||||
|
point_lon,
|
||||||
|
point_hae,
|
||||||
|
})
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
impl DeleteCoTPayload {
|
||||||
|
pub fn to_xml(&self) -> String {
|
||||||
|
let created_time = Utc::now().to_rfc3339_opts(SecondsFormat::Millis, true);
|
||||||
|
let stale_time =
|
||||||
|
(Utc::now() + Duration::seconds(60)).to_rfc3339_opts(SecondsFormat::Millis, true);
|
||||||
|
|
||||||
|
format!(
|
||||||
|
"<?xml version=\"1.0\" encoding=\"UTF-8\" ?><event type=\"t-x-d-d\" version=\"2.0\" how=\"m-g\" uid=\"{}.delete\" time=\"{}\" start=\"{}\" stale=\"{}\"><point ce=\"9999999\" le=\"9999999\" hae=\"{}\" lat=\"{}\" lon=\"{}\" /><detail><link uid=\"{}\" type=\"{}\" relation=\"none\" /><__forcedelete /></detail></event>",
|
||||||
|
self.target_uid,
|
||||||
|
created_time,
|
||||||
|
created_time,
|
||||||
|
stale_time,
|
||||||
|
self.point_hae,
|
||||||
|
self.point_lat,
|
||||||
|
self.point_lon,
|
||||||
|
self.target_uid,
|
||||||
|
self.target_type
|
||||||
|
)
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
#[cfg(test)]
|
||||||
|
mod tests {
|
||||||
|
use super::DeleteCoTPayload;
|
||||||
|
use arma_rs::FromArma;
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn parses_and_serializes_forced_delete_cot() {
|
||||||
|
let payload = DeleteCoTPayload::from_arma(
|
||||||
|
r#"["target-1","a-f-G-U-C",-30.1,-51.2,123.5]"#.to_string(),
|
||||||
|
)
|
||||||
|
.expect("delete CoT payload should parse");
|
||||||
|
|
||||||
|
assert_eq!(payload.target_uid, "target-1");
|
||||||
|
assert_eq!(payload.target_type, "a-f-G-U-C");
|
||||||
|
assert_eq!(payload.point_lat, -30.1);
|
||||||
|
assert_eq!(payload.point_lon, -51.2);
|
||||||
|
assert_eq!(payload.point_hae, 123.5);
|
||||||
|
|
||||||
|
let xml = payload.to_xml();
|
||||||
|
assert!(xml.starts_with("<?xml version=\"1.0\" encoding=\"UTF-8\" ?>"));
|
||||||
|
assert!(xml.contains("type=\"t-x-d-d\""));
|
||||||
|
assert!(xml.contains("uid=\"target-1.delete\""));
|
||||||
|
assert!(xml.contains("hae=\"123.5\" lat=\"-30.1\" lon=\"-51.2\""));
|
||||||
|
assert!(xml.contains("<link uid=\"target-1\" type=\"a-f-G-U-C\" relation=\"none\" />"));
|
||||||
|
assert!(xml.contains("<__forcedelete />"));
|
||||||
|
assert!(xml.ends_with("</detail></event>"));
|
||||||
|
}
|
||||||
|
}
|
||||||
@@ -40,6 +40,39 @@ impl DigitalPointerPayload {
|
|||||||
track_speed: None,
|
track_speed: None,
|
||||||
link_uid: Some(self.link_uid.clone()),
|
link_uid: Some(self.link_uid.clone()),
|
||||||
remarker: None,
|
remarker: None,
|
||||||
|
video_url: None,
|
||||||
|
stale_seconds: Some(7),
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#[cfg(test)]
|
||||||
|
mod tests {
|
||||||
|
use super::DigitalPointerPayload;
|
||||||
|
use arma_rs::FromArma;
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn parses_digital_pointer_and_maps_spi_contract() {
|
||||||
|
let payload = DigitalPointerPayload::from_arma(
|
||||||
|
r#"["operator-1","Falcon SPI",-30.1,-51.2,20.0]"#.to_string(),
|
||||||
|
)
|
||||||
|
.expect("digital pointer should parse");
|
||||||
|
|
||||||
|
assert_eq!(payload.link_uid, "operator-1");
|
||||||
|
assert_eq!(payload.contact_callsign, "Falcon SPI");
|
||||||
|
|
||||||
|
let cot = payload.to_cot();
|
||||||
|
assert_eq!(cot.uuid.as_deref(), Some("operator-1.SPI1"));
|
||||||
|
assert_eq!(cot.r#type.as_deref(), Some("b-m-p-s-p-i"));
|
||||||
|
assert_eq!(cot.point_lat, -30.1);
|
||||||
|
assert_eq!(cot.point_lon, -51.2);
|
||||||
|
assert_eq!(cot.point_hae, 20.0);
|
||||||
|
assert_eq!(cot.contact_callsign, "Falcon SPI");
|
||||||
|
assert_eq!(cot.link_uid.as_deref(), Some("operator-1"));
|
||||||
|
assert_eq!(cot.stale_seconds, Some(7));
|
||||||
|
assert!(cot.group_name.is_none());
|
||||||
|
assert!(cot.track_course.is_none());
|
||||||
|
assert!(cot.remarker.is_none());
|
||||||
|
assert!(cot.video_url.is_none());
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|||||||
@@ -124,3 +124,40 @@ impl ShapeCircleCoT {
|
|||||||
)
|
)
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#[cfg(test)]
|
||||||
|
mod tests {
|
||||||
|
use super::CircleCoTPayload;
|
||||||
|
use arma_rs::FromArma;
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn parses_circle_payload_maps_shape_and_serializes_cot() {
|
||||||
|
let payload = CircleCoTPayload::from_arma(
|
||||||
|
r#"["circle-1",-30.1,-51.2,20,100,50,30,"Area Alpha","creator-1","Falcon"]"#
|
||||||
|
.to_string(),
|
||||||
|
)
|
||||||
|
.expect("circle payload should parse");
|
||||||
|
|
||||||
|
assert_eq!(payload.uuid, "circle-1");
|
||||||
|
assert_eq!(payload.center_lat, -30.1);
|
||||||
|
assert_eq!(payload.center_lon, -51.2);
|
||||||
|
assert_eq!(payload.center_hae, 20.0);
|
||||||
|
assert_eq!(payload.major, 100.0);
|
||||||
|
assert_eq!(payload.minor, 50.0);
|
||||||
|
assert_eq!(payload.angle, 30.0);
|
||||||
|
|
||||||
|
let shape = payload.to_cot();
|
||||||
|
assert_eq!(shape.uid, "circle-1");
|
||||||
|
assert_eq!(shape.callsign, "Area Alpha");
|
||||||
|
assert_eq!(shape.creator_uid, "creator-1");
|
||||||
|
assert_eq!(shape.creator_callsign, "Falcon");
|
||||||
|
|
||||||
|
let xml = shape.to_xml("2026-08-07T17:00:00.000Z", "2026-08-07T18:00:00.000Z");
|
||||||
|
assert!(xml.contains("uid=\"circle-1\" type=\"u-d-c-c\""));
|
||||||
|
assert!(xml.contains("<point lat=\"-30.1\" lon=\"-51.2\" hae=\"20\""));
|
||||||
|
assert!(xml.contains("<ellipse major=\"100\" minor=\"50\" angle=\"30\" />"));
|
||||||
|
assert!(xml.contains("<link uid=\"creator-1\" type=\"self\" relation=\"p-p-CenterAnchor\" />"));
|
||||||
|
assert!(xml.contains("<contact callsign=\"Area Alpha\" />"));
|
||||||
|
assert!(xml.contains("<creator uid=\"creator-1\" callsign=\"Falcon\""));
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|||||||
@@ -1 +1,3 @@
|
|||||||
pub mod circle;
|
pub mod circle;
|
||||||
|
pub mod route;
|
||||||
|
pub mod shape;
|
||||||
|
|||||||
@@ -0,0 +1,204 @@
|
|||||||
|
use arma_rs::{FromArma, FromArmaError};
|
||||||
|
use uuid::Uuid;
|
||||||
|
|
||||||
|
#[derive(Clone)]
|
||||||
|
struct RoutePoint {
|
||||||
|
lat: f64,
|
||||||
|
lon: f64,
|
||||||
|
hae: f32,
|
||||||
|
}
|
||||||
|
|
||||||
|
pub struct RoutePayload {
|
||||||
|
pub uuid: String,
|
||||||
|
pub points: String,
|
||||||
|
pub callsign: String,
|
||||||
|
pub stale_seconds: i64,
|
||||||
|
pub color: i32,
|
||||||
|
pub stroke_weight: f64,
|
||||||
|
pub method: String,
|
||||||
|
pub route_type: String,
|
||||||
|
pub direction: String,
|
||||||
|
pub checkpoint_interval: usize,
|
||||||
|
}
|
||||||
|
|
||||||
|
impl FromArma for RoutePayload {
|
||||||
|
fn from_arma(data: String) -> Result<Self, FromArmaError> {
|
||||||
|
let (
|
||||||
|
uuid,
|
||||||
|
points,
|
||||||
|
callsign,
|
||||||
|
stale_seconds,
|
||||||
|
color,
|
||||||
|
stroke_weight,
|
||||||
|
method,
|
||||||
|
route_type,
|
||||||
|
direction,
|
||||||
|
checkpoint_interval,
|
||||||
|
) = <(
|
||||||
|
String,
|
||||||
|
String,
|
||||||
|
String,
|
||||||
|
i64,
|
||||||
|
i32,
|
||||||
|
f64,
|
||||||
|
String,
|
||||||
|
String,
|
||||||
|
String,
|
||||||
|
i32,
|
||||||
|
)>::from_arma(data)?;
|
||||||
|
|
||||||
|
Ok(Self {
|
||||||
|
uuid,
|
||||||
|
points,
|
||||||
|
callsign,
|
||||||
|
stale_seconds,
|
||||||
|
color,
|
||||||
|
stroke_weight,
|
||||||
|
method,
|
||||||
|
route_type,
|
||||||
|
direction,
|
||||||
|
checkpoint_interval: checkpoint_interval.max(1) as usize,
|
||||||
|
})
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
impl RoutePayload {
|
||||||
|
pub fn to_xml(&self, now: &str, stale: &str) -> String {
|
||||||
|
let points = parse_points(&self.points);
|
||||||
|
let links = route_links(&self.callsign, &points, self.checkpoint_interval);
|
||||||
|
|
||||||
|
format!(
|
||||||
|
r#"<?xml version="1.0" encoding="UTF-8" ?><event version="2.0" uid="{uid}" type="b-m-r" time="{now}" start="{now}" stale="{stale}" how="h-e" access="Undefined"><point lat="0.0" lon="0.0" hae="9999999.0" ce="9999999.0" le="9999999.0"/><detail>{links}<link_attr planningmethod="{direction}" color="{color}" method="{method}" prefix="CP" style="0" type="Vehicle" stroke="{stroke_weight}" direction="{direction}" routetype="{route_type}" order="Ascending Check Points"/><creator uid="ARMATAK" callsign="ArmaTAK" time="{now}" type="a-f-G-U-C"/><strokeColor value="{color}"/><strokeWeight value="{stroke_weight}"/><strokeStyle value="solid"/><labels_on value="false"/><__routeinfo><__navcues/></__routeinfo><color value="{color}"/><remarks/><contact callsign="{callsign}"/><archive/><height_unit>1</height_unit></detail></event>"#,
|
||||||
|
uid = escape_attr(&self.uuid),
|
||||||
|
now = now,
|
||||||
|
stale = stale,
|
||||||
|
links = links,
|
||||||
|
direction = escape_attr(&self.direction),
|
||||||
|
color = self.color,
|
||||||
|
method = escape_attr(&self.method),
|
||||||
|
stroke_weight = self.stroke_weight.max(1.0),
|
||||||
|
route_type = escape_attr(&self.route_type),
|
||||||
|
callsign = escape_attr(&self.callsign)
|
||||||
|
)
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
fn route_links(callsign: &str, points: &[RoutePoint], checkpoint_interval: usize) -> String {
|
||||||
|
let mut xml = String::new();
|
||||||
|
let last_index = points.len().saturating_sub(1);
|
||||||
|
let mut checkpoint_number = 1;
|
||||||
|
|
||||||
|
for (index, point) in points.iter().enumerate() {
|
||||||
|
let is_start = index == 0;
|
||||||
|
let is_end = index == last_index;
|
||||||
|
let is_checkpoint = !is_start && !is_end && index % checkpoint_interval == 0;
|
||||||
|
let point_callsign = if is_start {
|
||||||
|
format!("{} SP", callsign)
|
||||||
|
} else if is_end {
|
||||||
|
"VDO".to_string()
|
||||||
|
} else if is_checkpoint {
|
||||||
|
let name = format!("CP{}", checkpoint_number);
|
||||||
|
checkpoint_number += 1;
|
||||||
|
name
|
||||||
|
} else {
|
||||||
|
String::new()
|
||||||
|
};
|
||||||
|
let link_type = if point_callsign.is_empty() {
|
||||||
|
"b-m-p-c"
|
||||||
|
} else {
|
||||||
|
"b-m-p-w"
|
||||||
|
};
|
||||||
|
|
||||||
|
xml.push_str(&format!(
|
||||||
|
r#"<link uid="{link_uid}" callsign="{callsign}" type="{link_type}" point="{lat},{lon},{hae}" remarks="" relation="c"/>"#,
|
||||||
|
link_uid = escape_attr(&Uuid::new_v4().to_string()),
|
||||||
|
callsign = escape_attr(&point_callsign),
|
||||||
|
link_type = link_type,
|
||||||
|
lat = point.lat,
|
||||||
|
lon = point.lon,
|
||||||
|
hae = point.hae
|
||||||
|
));
|
||||||
|
}
|
||||||
|
|
||||||
|
xml
|
||||||
|
}
|
||||||
|
|
||||||
|
fn parse_points(raw: &str) -> Vec<RoutePoint> {
|
||||||
|
raw.split(';')
|
||||||
|
.filter_map(|entry| {
|
||||||
|
let parts: Vec<_> = entry.split(',').collect();
|
||||||
|
if parts.len() != 3 {
|
||||||
|
return None;
|
||||||
|
}
|
||||||
|
|
||||||
|
Some(RoutePoint {
|
||||||
|
lat: parts[0].parse().ok()?,
|
||||||
|
lon: parts[1].parse().ok()?,
|
||||||
|
hae: parts[2].parse().ok()?,
|
||||||
|
})
|
||||||
|
})
|
||||||
|
.collect()
|
||||||
|
}
|
||||||
|
|
||||||
|
fn escape_attr(value: &str) -> String {
|
||||||
|
value
|
||||||
|
.replace('&', "&")
|
||||||
|
.replace('"', """)
|
||||||
|
.replace('<', "<")
|
||||||
|
.replace('>', ">")
|
||||||
|
}
|
||||||
|
|
||||||
|
#[cfg(test)]
|
||||||
|
mod tests {
|
||||||
|
use super::{parse_points, route_links, RoutePayload, RoutePoint};
|
||||||
|
use arma_rs::FromArma;
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn parses_route_payload_clamps_interval_and_serializes_attributes() {
|
||||||
|
let mut payload = RoutePayload::from_arma(
|
||||||
|
r#"["route<&","","Route<&",600,-1,0.5,"Driving<&","Primary<&","Infil<&",0]"#
|
||||||
|
.to_string(),
|
||||||
|
)
|
||||||
|
.expect("route payload should parse");
|
||||||
|
payload.points = "-30.1,-51.2,10;-30.2,-51.3,20".to_string();
|
||||||
|
|
||||||
|
assert_eq!(payload.checkpoint_interval, 1);
|
||||||
|
assert_eq!(payload.stale_seconds, 600);
|
||||||
|
assert_eq!(payload.stroke_weight, 0.5);
|
||||||
|
|
||||||
|
let xml = payload.to_xml("2026-08-07T17:00:00.000Z", "2026-08-07T18:00:00.000Z");
|
||||||
|
assert!(xml.contains("uid=\"route<&\" type=\"b-m-r\""));
|
||||||
|
assert!(xml.contains("planningmethod=\"Infil<&\""));
|
||||||
|
assert!(xml.contains("method=\"Driving<&\""));
|
||||||
|
assert!(xml.contains("routetype=\"Primary<&\""));
|
||||||
|
assert!(xml.contains("stroke=\"1\""));
|
||||||
|
assert!(xml.contains("<contact callsign=\"Route<&\"/>"));
|
||||||
|
assert!(xml.contains("callsign=\"Route<& SP\""));
|
||||||
|
assert!(xml.contains("callsign=\"VDO\""));
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn route_links_cover_start_checkpoint_regular_and_end_points() {
|
||||||
|
let points = vec![
|
||||||
|
RoutePoint { lat: 1.0, lon: 1.0, hae: 1.0 },
|
||||||
|
RoutePoint { lat: 2.0, lon: 2.0, hae: 2.0 },
|
||||||
|
RoutePoint { lat: 3.0, lon: 3.0, hae: 3.0 },
|
||||||
|
RoutePoint { lat: 4.0, lon: 4.0, hae: 4.0 },
|
||||||
|
RoutePoint { lat: 5.0, lon: 5.0, hae: 5.0 },
|
||||||
|
];
|
||||||
|
|
||||||
|
let xml = route_links("Route", &points, 2);
|
||||||
|
assert!(xml.contains("callsign=\"Route SP\" type=\"b-m-p-w\""));
|
||||||
|
assert!(xml.contains("callsign=\"CP1\" type=\"b-m-p-w\""));
|
||||||
|
assert!(xml.contains("callsign=\"\" type=\"b-m-p-c\""));
|
||||||
|
assert!(xml.contains("callsign=\"VDO\" type=\"b-m-p-w\""));
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn point_parser_drops_malformed_entries() {
|
||||||
|
let points = parse_points("1,2,3;missing;bad,2,3;4,bad,6;7,8,bad;9,10,11");
|
||||||
|
assert_eq!(points.len(), 2);
|
||||||
|
assert_eq!(points[0].lat, 1.0);
|
||||||
|
assert_eq!(points[1].lat, 9.0);
|
||||||
|
}
|
||||||
|
}
|
||||||
@@ -0,0 +1,376 @@
|
|||||||
|
use arma_rs::{FromArma, FromArmaError};
|
||||||
|
|
||||||
|
#[derive(Clone)]
|
||||||
|
struct DrawPoint {
|
||||||
|
lat: f64,
|
||||||
|
lon: f64,
|
||||||
|
hae: f32,
|
||||||
|
}
|
||||||
|
|
||||||
|
pub struct DrawEllipsePayload {
|
||||||
|
pub uuid: String,
|
||||||
|
pub cot_type: String,
|
||||||
|
pub center_lat: f64,
|
||||||
|
pub center_lon: f64,
|
||||||
|
pub center_hae: f32,
|
||||||
|
pub major: f64,
|
||||||
|
pub minor: f64,
|
||||||
|
pub angle: f32,
|
||||||
|
pub callsign: String,
|
||||||
|
pub stale_seconds: i64,
|
||||||
|
pub stroke_color: i32,
|
||||||
|
pub fill_color: i32,
|
||||||
|
pub stroke_weight: f64,
|
||||||
|
pub milsym: String,
|
||||||
|
}
|
||||||
|
|
||||||
|
pub struct DrawLinksPayload {
|
||||||
|
pub uuid: String,
|
||||||
|
pub cot_type: String,
|
||||||
|
pub center_lat: f64,
|
||||||
|
pub center_lon: f64,
|
||||||
|
pub center_hae: f32,
|
||||||
|
pub points: String,
|
||||||
|
pub callsign: String,
|
||||||
|
pub stale_seconds: i64,
|
||||||
|
pub stroke_color: i32,
|
||||||
|
pub fill_color: i32,
|
||||||
|
pub stroke_weight: f64,
|
||||||
|
pub stroke_style: String,
|
||||||
|
pub closed: bool,
|
||||||
|
pub milsym: String,
|
||||||
|
}
|
||||||
|
|
||||||
|
impl FromArma for DrawEllipsePayload {
|
||||||
|
fn from_arma(data: String) -> Result<Self, FromArmaError> {
|
||||||
|
let (
|
||||||
|
uuid,
|
||||||
|
cot_type,
|
||||||
|
center_lat,
|
||||||
|
center_lon,
|
||||||
|
center_hae,
|
||||||
|
major,
|
||||||
|
minor,
|
||||||
|
angle,
|
||||||
|
callsign,
|
||||||
|
stale_seconds,
|
||||||
|
stroke_color,
|
||||||
|
fill_color,
|
||||||
|
stroke_weight,
|
||||||
|
milsym,
|
||||||
|
) = <(
|
||||||
|
String,
|
||||||
|
String,
|
||||||
|
f64,
|
||||||
|
f64,
|
||||||
|
f32,
|
||||||
|
f64,
|
||||||
|
f64,
|
||||||
|
f32,
|
||||||
|
String,
|
||||||
|
i64,
|
||||||
|
i32,
|
||||||
|
i32,
|
||||||
|
f64,
|
||||||
|
String,
|
||||||
|
)>::from_arma(data)?;
|
||||||
|
|
||||||
|
Ok(Self {
|
||||||
|
uuid,
|
||||||
|
cot_type,
|
||||||
|
center_lat,
|
||||||
|
center_lon,
|
||||||
|
center_hae,
|
||||||
|
major,
|
||||||
|
minor,
|
||||||
|
angle,
|
||||||
|
callsign,
|
||||||
|
stale_seconds,
|
||||||
|
stroke_color,
|
||||||
|
fill_color,
|
||||||
|
stroke_weight,
|
||||||
|
milsym,
|
||||||
|
})
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
impl FromArma for DrawLinksPayload {
|
||||||
|
fn from_arma(data: String) -> Result<Self, FromArmaError> {
|
||||||
|
let (
|
||||||
|
uuid,
|
||||||
|
cot_type,
|
||||||
|
center_lat,
|
||||||
|
center_lon,
|
||||||
|
center_hae,
|
||||||
|
points,
|
||||||
|
callsign,
|
||||||
|
stale_seconds,
|
||||||
|
stroke_color,
|
||||||
|
fill_color,
|
||||||
|
stroke_weight,
|
||||||
|
stroke_style,
|
||||||
|
closed,
|
||||||
|
milsym,
|
||||||
|
) = <(
|
||||||
|
String,
|
||||||
|
String,
|
||||||
|
f64,
|
||||||
|
f64,
|
||||||
|
f32,
|
||||||
|
String,
|
||||||
|
String,
|
||||||
|
i64,
|
||||||
|
i32,
|
||||||
|
i32,
|
||||||
|
f64,
|
||||||
|
String,
|
||||||
|
bool,
|
||||||
|
String,
|
||||||
|
)>::from_arma(data)?;
|
||||||
|
|
||||||
|
Ok(Self {
|
||||||
|
uuid,
|
||||||
|
cot_type,
|
||||||
|
center_lat,
|
||||||
|
center_lon,
|
||||||
|
center_hae,
|
||||||
|
points,
|
||||||
|
callsign,
|
||||||
|
stale_seconds,
|
||||||
|
stroke_color,
|
||||||
|
fill_color,
|
||||||
|
stroke_weight,
|
||||||
|
stroke_style,
|
||||||
|
closed,
|
||||||
|
milsym,
|
||||||
|
})
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
impl DrawEllipsePayload {
|
||||||
|
pub fn to_xml(&self, now: &str, stale: &str) -> String {
|
||||||
|
shape_event(
|
||||||
|
&self.uuid,
|
||||||
|
&self.cot_type,
|
||||||
|
self.center_lat,
|
||||||
|
self.center_lon,
|
||||||
|
self.center_hae,
|
||||||
|
now,
|
||||||
|
stale,
|
||||||
|
&self.callsign,
|
||||||
|
&ellipse_shape_detail(
|
||||||
|
&self.uuid,
|
||||||
|
self.major,
|
||||||
|
self.minor,
|
||||||
|
self.angle,
|
||||||
|
self.stroke_color,
|
||||||
|
self.fill_color,
|
||||||
|
self.stroke_weight,
|
||||||
|
),
|
||||||
|
self.stroke_color,
|
||||||
|
self.fill_color,
|
||||||
|
self.stroke_weight,
|
||||||
|
"solid",
|
||||||
|
&self.milsym,
|
||||||
|
)
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
impl DrawLinksPayload {
|
||||||
|
pub fn to_xml(&self, now: &str, stale: &str) -> String {
|
||||||
|
let points = parse_points(&self.points);
|
||||||
|
let shape_detail = links_detail(&points, self.closed);
|
||||||
|
|
||||||
|
shape_event(
|
||||||
|
&self.uuid,
|
||||||
|
&self.cot_type,
|
||||||
|
self.center_lat,
|
||||||
|
self.center_lon,
|
||||||
|
self.center_hae,
|
||||||
|
now,
|
||||||
|
stale,
|
||||||
|
&self.callsign,
|
||||||
|
&shape_detail,
|
||||||
|
self.stroke_color,
|
||||||
|
self.fill_color,
|
||||||
|
self.stroke_weight,
|
||||||
|
&self.stroke_style,
|
||||||
|
&self.milsym,
|
||||||
|
)
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
fn shape_event(
|
||||||
|
uid: &str,
|
||||||
|
cot_type: &str,
|
||||||
|
lat: f64,
|
||||||
|
lon: f64,
|
||||||
|
hae: f32,
|
||||||
|
now: &str,
|
||||||
|
stale: &str,
|
||||||
|
callsign: &str,
|
||||||
|
shape_detail: &str,
|
||||||
|
stroke_color: i32,
|
||||||
|
fill_color: i32,
|
||||||
|
stroke_weight: f64,
|
||||||
|
stroke_style: &str,
|
||||||
|
milsym: &str,
|
||||||
|
) -> String {
|
||||||
|
let milsym_detail = if milsym.trim().is_empty() {
|
||||||
|
String::new()
|
||||||
|
} else {
|
||||||
|
format!(r#"<__milsym id="{}" />"#, escape_attr(milsym))
|
||||||
|
};
|
||||||
|
|
||||||
|
format!(
|
||||||
|
r#"<?xml version="1.0" encoding="UTF-8" ?><event version="2.0" uid="{uid}" type="{cot_type}" time="{now}" start="{now}" stale="{stale}" how="h-e" access="Undefined"><point lat="{lat}" lon="{lon}" hae="{hae}" ce="10.9" le="9999999.0" /><detail>{shape_detail}<__shapeExtras cpvis="true" editable="true" /><contact callsign="{callsign}" /><remarks /><archive /><labels_on value="true" /><strokeColor value="{stroke_color}" /><strokeWeight value="{stroke_weight}" /><strokeStyle value="{stroke_style}" /><fillColor value="{fill_color}" /><precisionlocation altsrc="GPS" geopointsrc="GPS" />{milsym_detail}</detail></event>"#,
|
||||||
|
uid = escape_attr(uid),
|
||||||
|
cot_type = escape_attr(cot_type),
|
||||||
|
now = now,
|
||||||
|
stale = stale,
|
||||||
|
lat = lat,
|
||||||
|
lon = lon,
|
||||||
|
hae = hae,
|
||||||
|
shape_detail = shape_detail,
|
||||||
|
callsign = escape_attr(callsign),
|
||||||
|
stroke_color = stroke_color,
|
||||||
|
stroke_weight = stroke_weight,
|
||||||
|
stroke_style = escape_attr(stroke_style),
|
||||||
|
fill_color = fill_color,
|
||||||
|
milsym_detail = milsym_detail
|
||||||
|
)
|
||||||
|
}
|
||||||
|
|
||||||
|
fn ellipse_shape_detail(
|
||||||
|
uid: &str,
|
||||||
|
major: f64,
|
||||||
|
minor: f64,
|
||||||
|
angle: f32,
|
||||||
|
stroke_color: i32,
|
||||||
|
fill_color: i32,
|
||||||
|
stroke_weight: f64,
|
||||||
|
) -> String {
|
||||||
|
format!(
|
||||||
|
r#"<shape><ellipse major="{major}" minor="{minor}" angle="{angle}" /><link uid="{style_uid}" type="b-x-KmlStyle" relation="p-c"><Style><LineStyle><color>{stroke_hex}</color><width>{stroke_weight}</width></LineStyle><PolyStyle><color>{fill_hex}</color></PolyStyle></Style></link></shape>"#,
|
||||||
|
major = major,
|
||||||
|
minor = minor,
|
||||||
|
angle = angle,
|
||||||
|
style_uid = escape_attr(&format!("{}.Style", uid)),
|
||||||
|
stroke_hex = argb_hex(stroke_color),
|
||||||
|
stroke_weight = stroke_weight,
|
||||||
|
fill_hex = argb_hex(fill_color)
|
||||||
|
)
|
||||||
|
}
|
||||||
|
|
||||||
|
fn links_detail(points: &[DrawPoint], closed: bool) -> String {
|
||||||
|
let mut detail = String::new();
|
||||||
|
|
||||||
|
for point in points {
|
||||||
|
detail.push_str(&link_detail(point));
|
||||||
|
}
|
||||||
|
|
||||||
|
if closed {
|
||||||
|
if let Some(first) = points.first() {
|
||||||
|
detail.push_str(&link_detail(first));
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
detail
|
||||||
|
}
|
||||||
|
|
||||||
|
fn link_detail(point: &DrawPoint) -> String {
|
||||||
|
format!(
|
||||||
|
r#"<link point="{lat},{lon},{hae}" />"#,
|
||||||
|
lat = point.lat,
|
||||||
|
lon = point.lon,
|
||||||
|
hae = point.hae
|
||||||
|
)
|
||||||
|
}
|
||||||
|
|
||||||
|
fn parse_points(raw: &str) -> Vec<DrawPoint> {
|
||||||
|
raw.split(';')
|
||||||
|
.filter_map(|entry| {
|
||||||
|
let parts: Vec<_> = entry.split(',').collect();
|
||||||
|
if parts.len() != 3 {
|
||||||
|
return None;
|
||||||
|
}
|
||||||
|
|
||||||
|
Some(DrawPoint {
|
||||||
|
lat: parts[0].parse().ok()?,
|
||||||
|
lon: parts[1].parse().ok()?,
|
||||||
|
hae: parts[2].parse().ok()?,
|
||||||
|
})
|
||||||
|
})
|
||||||
|
.collect()
|
||||||
|
}
|
||||||
|
|
||||||
|
fn argb_hex(color: i32) -> String {
|
||||||
|
format!("{:08x}", color as u32)
|
||||||
|
}
|
||||||
|
|
||||||
|
fn escape_attr(value: &str) -> String {
|
||||||
|
value
|
||||||
|
.replace('&', "&")
|
||||||
|
.replace('"', """)
|
||||||
|
.replace('<', "<")
|
||||||
|
.replace('>', ">")
|
||||||
|
}
|
||||||
|
|
||||||
|
#[cfg(test)]
|
||||||
|
mod tests {
|
||||||
|
use super::{parse_points, DrawEllipsePayload, DrawLinksPayload};
|
||||||
|
use arma_rs::FromArma;
|
||||||
|
|
||||||
|
const NOW: &str = "2026-08-07T17:00:00.000Z";
|
||||||
|
const STALE: &str = "2026-08-07T18:00:00.000Z";
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn parses_and_serializes_ellipse_shape_with_milsym() {
|
||||||
|
let payload = DrawEllipsePayload::from_arma(
|
||||||
|
r#"["ellipse<&","u-d-c-e",-30.1,-51.2,10,100,50,25,"Ellipse<&",600,-1,-1761607681,3,"SFGPUCI----K<&"]"#
|
||||||
|
.to_string(),
|
||||||
|
)
|
||||||
|
.expect("ellipse payload should parse");
|
||||||
|
|
||||||
|
assert_eq!(payload.uuid, "ellipse<&");
|
||||||
|
assert_eq!(payload.stale_seconds, 600);
|
||||||
|
assert_eq!(payload.major, 100.0);
|
||||||
|
assert_eq!(payload.minor, 50.0);
|
||||||
|
|
||||||
|
let xml = payload.to_xml(NOW, STALE);
|
||||||
|
assert!(xml.contains("uid=\"ellipse<&\" type=\"u-d-c-e\""));
|
||||||
|
assert!(xml.contains("<ellipse major=\"100\" minor=\"50\" angle=\"25\" />"));
|
||||||
|
assert!(xml.contains("<color>ffffffff</color>"));
|
||||||
|
assert!(xml.contains("<color>96ffffff</color>"));
|
||||||
|
assert!(xml.contains("<contact callsign=\"Ellipse<&\" />"));
|
||||||
|
assert!(xml.contains("<__milsym id=\"SFGPUCI----K<&\" />"));
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn parses_and_serializes_closed_link_shape_without_milsym() {
|
||||||
|
let mut payload = DrawLinksPayload::from_arma(
|
||||||
|
r#"["shape<&","u-d-f",1,2,3,"","Polygon<&",300,-16777216,16777215,2,"dashed<&",true,""]"#
|
||||||
|
.to_string(),
|
||||||
|
)
|
||||||
|
.expect("link shape payload should parse");
|
||||||
|
payload.points = "1,2,3;4,5,6".to_string();
|
||||||
|
|
||||||
|
assert!(payload.closed);
|
||||||
|
assert_eq!(payload.stroke_style, "dashed<&");
|
||||||
|
|
||||||
|
let xml = payload.to_xml(NOW, STALE);
|
||||||
|
assert!(xml.contains("uid=\"shape<&\" type=\"u-d-f\""));
|
||||||
|
assert_eq!(xml.matches("<link point=\"1,2,3\" />").count(), 2);
|
||||||
|
assert_eq!(xml.matches("<link point=\"4,5,6\" />").count(), 1);
|
||||||
|
assert!(xml.contains("<strokeStyle value=\"dashed<&\" />"));
|
||||||
|
assert!(!xml.contains("<__milsym"));
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn point_parser_drops_invalid_shape_points() {
|
||||||
|
let points = parse_points("1,2,3;missing;bad,2,3;4,bad,6;7,8,bad;9,10,11");
|
||||||
|
assert_eq!(points.len(), 2);
|
||||||
|
assert_eq!(points[0].lat, 1.0);
|
||||||
|
assert_eq!(points[1].lon, 10.0);
|
||||||
|
}
|
||||||
|
}
|
||||||
@@ -57,6 +57,43 @@ impl EudCoTPayload {
|
|||||||
track_speed: Some(self.track_speed),
|
track_speed: Some(self.track_speed),
|
||||||
link_uid: None,
|
link_uid: None,
|
||||||
remarker: None,
|
remarker: None,
|
||||||
|
video_url: None,
|
||||||
|
stale_seconds: None,
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#[cfg(test)]
|
||||||
|
mod tests {
|
||||||
|
use super::EudCoTPayload;
|
||||||
|
use arma_rs::FromArma;
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn parses_eud_payload_and_maps_all_tactical_fields() {
|
||||||
|
let payload = EudCoTPayload::from_arma(
|
||||||
|
r#"["eud-1",-30.1,-51.2,75.0,"Falcon","Cyan","Team Member",90,4.5]"#
|
||||||
|
.to_string(),
|
||||||
|
)
|
||||||
|
.expect("EUD payload should parse");
|
||||||
|
|
||||||
|
assert_eq!(payload.uuid, "eud-1");
|
||||||
|
assert_eq!(payload.contact_callsign, "Falcon");
|
||||||
|
assert_eq!(payload.group_name, "Cyan");
|
||||||
|
assert_eq!(payload.group_role, "Team Member");
|
||||||
|
|
||||||
|
let cot = payload.to_cot();
|
||||||
|
assert_eq!(cot.uuid.as_deref(), Some("eud-1"));
|
||||||
|
assert_eq!(cot.point_lat, -30.1);
|
||||||
|
assert_eq!(cot.point_lon, -51.2);
|
||||||
|
assert_eq!(cot.point_hae, 75.0);
|
||||||
|
assert_eq!(cot.contact_callsign, "Falcon");
|
||||||
|
assert_eq!(cot.group_name.as_deref(), Some("Cyan"));
|
||||||
|
assert_eq!(cot.group_role.as_deref(), Some("Team Member"));
|
||||||
|
assert_eq!(cot.track_course, Some(90));
|
||||||
|
assert_eq!(cot.track_speed, Some(4.5));
|
||||||
|
assert!(cot.link_uid.is_none());
|
||||||
|
assert!(cot.remarker.is_none());
|
||||||
|
assert!(cot.video_url.is_none());
|
||||||
|
assert!(cot.stale_seconds.is_none());
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|||||||
@@ -54,6 +54,48 @@ impl ExternalPositionPayload {
|
|||||||
track_speed: Some(self.track_speed),
|
track_speed: Some(self.track_speed),
|
||||||
link_uid: None,
|
link_uid: None,
|
||||||
remarker: Some(self.remarker.clone()),
|
remarker: Some(self.remarker.clone()),
|
||||||
|
video_url: None,
|
||||||
|
stale_seconds: None,
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#[cfg(test)]
|
||||||
|
mod tests {
|
||||||
|
use super::ExternalPositionPayload;
|
||||||
|
use arma_rs::FromArma;
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn parses_external_position_and_maps_it_to_generic_cot() {
|
||||||
|
let payload = ExternalPositionPayload::from_arma(
|
||||||
|
r#"["gps-1",-30.1,-51.2,75.0,"Falcon",270,11.5,"external GPS"]"#
|
||||||
|
.to_string(),
|
||||||
|
)
|
||||||
|
.expect("external position should parse");
|
||||||
|
|
||||||
|
assert_eq!(payload.uuid, "gps-1");
|
||||||
|
assert_eq!(payload.point_lat, -30.1);
|
||||||
|
assert_eq!(payload.point_lon, -51.2);
|
||||||
|
assert_eq!(payload.point_hae, 75.0);
|
||||||
|
assert_eq!(payload.contact_callsign, "Falcon");
|
||||||
|
assert_eq!(payload.track_course, 270);
|
||||||
|
assert_eq!(payload.track_speed, 11.5);
|
||||||
|
assert_eq!(payload.remarker, "external GPS");
|
||||||
|
|
||||||
|
let cot = payload.to_cot();
|
||||||
|
assert_eq!(cot.uuid.as_deref(), Some("gps-1"));
|
||||||
|
assert_eq!(cot.r#type, None);
|
||||||
|
assert_eq!(cot.point_lat, -30.1);
|
||||||
|
assert_eq!(cot.point_lon, -51.2);
|
||||||
|
assert_eq!(cot.point_hae, 75.0);
|
||||||
|
assert_eq!(cot.contact_callsign, "Falcon");
|
||||||
|
assert_eq!(cot.track_course, Some(270));
|
||||||
|
assert_eq!(cot.track_speed, Some(11.5));
|
||||||
|
assert_eq!(cot.remarker.as_deref(), Some("external GPS"));
|
||||||
|
assert!(cot.group_name.is_none());
|
||||||
|
assert!(cot.group_role.is_none());
|
||||||
|
assert!(cot.link_uid.is_none());
|
||||||
|
assert!(cot.video_url.is_none());
|
||||||
|
assert!(cot.stale_seconds.is_none());
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|||||||
+104
@@ -0,0 +1,104 @@
|
|||||||
|
use arma_rs::{FromArma, FromArmaError};
|
||||||
|
use chrono::{SecondsFormat, Utc};
|
||||||
|
|
||||||
|
pub struct LaserRangeFinderPayload {
|
||||||
|
pub uid: String,
|
||||||
|
pub distance_meters: f64,
|
||||||
|
pub azimuth_degrees: f64,
|
||||||
|
pub elevation_degrees: f64,
|
||||||
|
}
|
||||||
|
|
||||||
|
impl FromArma for LaserRangeFinderPayload {
|
||||||
|
fn from_arma(data: String) -> Result<LaserRangeFinderPayload, FromArmaError> {
|
||||||
|
let (uid, distance_meters, azimuth_degrees, elevation_degrees) =
|
||||||
|
<(String, f64, f64, f64)>::from_arma(data)?;
|
||||||
|
Ok(Self {
|
||||||
|
uid,
|
||||||
|
distance_meters,
|
||||||
|
azimuth_degrees,
|
||||||
|
elevation_degrees,
|
||||||
|
})
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
impl LaserRangeFinderPayload {
|
||||||
|
pub fn to_lrf_message(&self) -> String {
|
||||||
|
let timestamp = Utc::now().to_rfc3339_opts(SecondsFormat::Millis, true);
|
||||||
|
|
||||||
|
format!(
|
||||||
|
"1,{},{},{:.2},{:.2},{:.2}",
|
||||||
|
self.uid,
|
||||||
|
timestamp,
|
||||||
|
self.distance_meters.max(0.0),
|
||||||
|
normalize_degrees(self.azimuth_degrees),
|
||||||
|
self.elevation_degrees
|
||||||
|
)
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
pub struct LaserRangeFinderClearPayload {
|
||||||
|
pub uid: String,
|
||||||
|
}
|
||||||
|
|
||||||
|
impl FromArma for LaserRangeFinderClearPayload {
|
||||||
|
fn from_arma(data: String) -> Result<LaserRangeFinderClearPayload, FromArmaError> {
|
||||||
|
let uid = String::from_arma(data)?;
|
||||||
|
Ok(Self { uid })
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
impl LaserRangeFinderClearPayload {
|
||||||
|
pub fn to_lrf_message(&self) -> String {
|
||||||
|
let timestamp = Utc::now().to_rfc3339_opts(SecondsFormat::Millis, true);
|
||||||
|
format!("1,{},{},RANGE_ERROR", self.uid, timestamp)
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
fn normalize_degrees(degrees: f64) -> f64 {
|
||||||
|
degrees.rem_euclid(360.0)
|
||||||
|
}
|
||||||
|
|
||||||
|
#[cfg(test)]
|
||||||
|
mod tests {
|
||||||
|
use super::{LaserRangeFinderClearPayload, LaserRangeFinderPayload};
|
||||||
|
use arma_rs::FromArma;
|
||||||
|
use chrono::DateTime;
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn parses_lrf_payload_and_serializes_normalized_message() {
|
||||||
|
let payload = LaserRangeFinderPayload::from_arma(
|
||||||
|
r#"["laser-1",-5,-10,2.5]"#.to_string(),
|
||||||
|
)
|
||||||
|
.expect("LRF payload should parse");
|
||||||
|
|
||||||
|
assert_eq!(payload.uid, "laser-1");
|
||||||
|
assert_eq!(payload.distance_meters, -5.0);
|
||||||
|
assert_eq!(payload.azimuth_degrees, -10.0);
|
||||||
|
assert_eq!(payload.elevation_degrees, 2.5);
|
||||||
|
|
||||||
|
let message = payload.to_lrf_message();
|
||||||
|
let fields: Vec<_> = message.split(',').collect();
|
||||||
|
assert_eq!(fields.len(), 6);
|
||||||
|
assert_eq!(fields[0], "1");
|
||||||
|
assert_eq!(fields[1], "laser-1");
|
||||||
|
assert!(DateTime::parse_from_rfc3339(fields[2]).is_ok());
|
||||||
|
assert_eq!(fields[3], "0.00");
|
||||||
|
assert_eq!(fields[4], "350.00");
|
||||||
|
assert_eq!(fields[5], "2.50");
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn parses_clear_payload_and_serializes_range_error() {
|
||||||
|
let payload = LaserRangeFinderClearPayload::from_arma(r#""laser-2""#.to_string())
|
||||||
|
.expect("clear LRF payload should parse");
|
||||||
|
assert_eq!(payload.uid, "laser-2");
|
||||||
|
|
||||||
|
let message = payload.to_lrf_message();
|
||||||
|
let fields: Vec<_> = message.split(',').collect();
|
||||||
|
assert_eq!(fields.len(), 4);
|
||||||
|
assert_eq!(fields[0], "1");
|
||||||
|
assert_eq!(fields[1], "laser-2");
|
||||||
|
assert!(DateTime::parse_from_rfc3339(fields[2]).is_ok());
|
||||||
|
assert_eq!(fields[3], "RANGE_ERROR");
|
||||||
|
}
|
||||||
|
}
|
||||||
@@ -145,3 +145,39 @@ impl MessageCot {
|
|||||||
xml
|
xml
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#[cfg(test)]
|
||||||
|
mod tests {
|
||||||
|
use super::{MessageCot, MessagePayload};
|
||||||
|
use arma_rs::FromArma;
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn parses_chat_payload_and_serializes_geochat_event() {
|
||||||
|
let payload = MessagePayload::from_arma(
|
||||||
|
r#"["Falcon","Operations Room","Message received",-30.1,-51.2,15.0,"sender-1"]"#
|
||||||
|
.to_string(),
|
||||||
|
)
|
||||||
|
.expect("chat payload should parse");
|
||||||
|
|
||||||
|
assert_eq!(payload.sender_callsign, "Falcon");
|
||||||
|
assert_eq!(payload.chatroom, "Operations Room");
|
||||||
|
assert_eq!(payload.message_text, "Message received");
|
||||||
|
assert_eq!(payload.sender_uid, "sender-1");
|
||||||
|
|
||||||
|
let cot = MessageCot::from_payload(payload);
|
||||||
|
let xml = cot.to_xml();
|
||||||
|
|
||||||
|
assert!(xml.starts_with("<?xml version=\"1.0\" encoding=\"UTF-8\"?>"));
|
||||||
|
assert!(xml.contains("type=\"b-t-f\""));
|
||||||
|
assert!(xml.contains("uid=\"GeoChat.sender-1.Operations_Room."));
|
||||||
|
assert!(xml.contains("lat=\"-30.1\" lon=\"-51.2\" hae=\"15\""));
|
||||||
|
assert!(xml.contains("chatroom=\"Operations Room\""));
|
||||||
|
assert!(xml.contains("senderCallsign=\"Falcon\""));
|
||||||
|
assert!(xml.contains("<chatgrp uid0=\"sender-1\" uid1=\"Operations Room\" id=\"Operations Room\" />"));
|
||||||
|
assert!(xml.contains("<link uid=\"sender-1\" type=\"a-f-G-U-C\" relation=\"p-p\" />"));
|
||||||
|
assert!(xml.contains("<__serverdestination destinations=\"0.0.0.0:0:tcp:sender-1\" />"));
|
||||||
|
assert!(xml.contains("<remarks source=\"ARMATAK.sender-1\" to=\"Operations Room\""));
|
||||||
|
assert!(xml.contains(">Message received</remarks>"));
|
||||||
|
assert!(xml.ends_with("</detail></event>"));
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|||||||
@@ -1,7 +1,12 @@
|
|||||||
pub mod cot;
|
pub mod cot;
|
||||||
|
pub mod delete;
|
||||||
pub mod digital_pointer;
|
pub mod digital_pointer;
|
||||||
pub mod draws;
|
pub mod draws;
|
||||||
pub mod eud;
|
pub mod eud;
|
||||||
pub mod gps;
|
pub mod gps;
|
||||||
|
pub mod lrf;
|
||||||
pub mod message;
|
pub mod message;
|
||||||
pub mod nato;
|
pub mod nato;
|
||||||
|
pub mod report_marker;
|
||||||
|
pub mod uas;
|
||||||
|
pub mod video;
|
||||||
|
|||||||
@@ -11,10 +11,40 @@ pub struct MarkerCoTPayload {
|
|||||||
pub contact_callsign: String,
|
pub contact_callsign: String,
|
||||||
pub track_course: i32,
|
pub track_course: i32,
|
||||||
pub track_speed: f32,
|
pub track_speed: f32,
|
||||||
|
pub video_url: Option<String>,
|
||||||
}
|
}
|
||||||
|
|
||||||
impl FromArma for MarkerCoTPayload {
|
impl FromArma for MarkerCoTPayload {
|
||||||
fn from_arma(data: String) -> Result<MarkerCoTPayload, FromArmaError> {
|
fn from_arma(data: String) -> Result<MarkerCoTPayload, FromArmaError> {
|
||||||
|
if let Ok((
|
||||||
|
uuid,
|
||||||
|
r#type,
|
||||||
|
point_lat,
|
||||||
|
point_lon,
|
||||||
|
point_hae,
|
||||||
|
contact_callsign,
|
||||||
|
track_course,
|
||||||
|
track_speed,
|
||||||
|
video_url,
|
||||||
|
)) = <(String, String, f64, f64, f32, String, i32, f32, String)>::from_arma(data.clone())
|
||||||
|
{
|
||||||
|
return Ok(Self {
|
||||||
|
uuid,
|
||||||
|
r#type,
|
||||||
|
point_lat,
|
||||||
|
point_lon,
|
||||||
|
point_hae,
|
||||||
|
contact_callsign,
|
||||||
|
track_course,
|
||||||
|
track_speed,
|
||||||
|
video_url: if video_url.trim().is_empty() {
|
||||||
|
None
|
||||||
|
} else {
|
||||||
|
Some(video_url)
|
||||||
|
},
|
||||||
|
});
|
||||||
|
}
|
||||||
|
|
||||||
let (
|
let (
|
||||||
uuid,
|
uuid,
|
||||||
r#type,
|
r#type,
|
||||||
@@ -34,6 +64,7 @@ impl FromArma for MarkerCoTPayload {
|
|||||||
contact_callsign,
|
contact_callsign,
|
||||||
track_course,
|
track_course,
|
||||||
track_speed,
|
track_speed,
|
||||||
|
video_url: None,
|
||||||
})
|
})
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
@@ -55,6 +86,65 @@ impl MarkerCoTPayload {
|
|||||||
track_speed: Some(self.track_speed),
|
track_speed: Some(self.track_speed),
|
||||||
link_uid: None,
|
link_uid: None,
|
||||||
remarker: None,
|
remarker: None,
|
||||||
|
video_url: self.video_url.clone(),
|
||||||
|
stale_seconds: None,
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#[cfg(test)]
|
||||||
|
mod tests {
|
||||||
|
use super::MarkerCoTPayload;
|
||||||
|
use arma_rs::FromArma;
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn parses_marker_with_video_and_maps_it_to_cot() {
|
||||||
|
let payload = MarkerCoTPayload::from_arma(
|
||||||
|
r#"["marker-1","a-f-G-U-C",-30.1,-51.2,100.0,"Falcon",180,10.5,"rtsp://video.example.test:8554/live"]"#
|
||||||
|
.to_string(),
|
||||||
|
)
|
||||||
|
.expect("marker with video should parse");
|
||||||
|
|
||||||
|
assert_eq!(
|
||||||
|
payload.video_url.as_deref(),
|
||||||
|
Some("rtsp://video.example.test:8554/live")
|
||||||
|
);
|
||||||
|
|
||||||
|
let cot = payload.to_cot();
|
||||||
|
assert_eq!(cot.uuid.as_deref(), Some("marker-1"));
|
||||||
|
assert_eq!(cot.r#type.as_deref(), Some("a-f-G-U-C"));
|
||||||
|
assert_eq!(cot.point_lat, -30.1);
|
||||||
|
assert_eq!(cot.point_lon, -51.2);
|
||||||
|
assert_eq!(cot.point_hae, 100.0);
|
||||||
|
assert_eq!(cot.contact_callsign, "Falcon");
|
||||||
|
assert_eq!(cot.track_course, Some(180));
|
||||||
|
assert_eq!(cot.track_speed, Some(10.5));
|
||||||
|
assert_eq!(
|
||||||
|
cot.video_url.as_deref(),
|
||||||
|
Some("rtsp://video.example.test:8554/live")
|
||||||
|
);
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn treats_blank_video_url_as_absent() {
|
||||||
|
let payload = MarkerCoTPayload::from_arma(
|
||||||
|
r#"["marker-2","a-f-G-U-C",1,2,3,"Raven",90,5," "]"#.to_string(),
|
||||||
|
)
|
||||||
|
.expect("marker with blank video should parse");
|
||||||
|
|
||||||
|
assert!(payload.video_url.is_none());
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn accepts_legacy_marker_payload_without_video_field() {
|
||||||
|
let payload = MarkerCoTPayload::from_arma(
|
||||||
|
r#"["marker-3","a-f-G-U-C",1,2,3,"Viper",45,2.5]"#.to_string(),
|
||||||
|
)
|
||||||
|
.expect("legacy marker should parse");
|
||||||
|
|
||||||
|
assert_eq!(payload.uuid, "marker-3");
|
||||||
|
assert_eq!(payload.r#type, "a-f-G-U-C");
|
||||||
|
assert_eq!(payload.contact_callsign, "Viper");
|
||||||
|
assert!(payload.video_url.is_none());
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|||||||
@@ -0,0 +1,97 @@
|
|||||||
|
use arma_rs::{FromArma, FromArmaError};
|
||||||
|
|
||||||
|
use super::cot::CursorOverTime;
|
||||||
|
|
||||||
|
pub struct ReportMarkerCoTPayload {
|
||||||
|
pub uuid: String,
|
||||||
|
pub r#type: String,
|
||||||
|
pub point_lat: f64,
|
||||||
|
pub point_lon: f64,
|
||||||
|
pub point_hae: f32,
|
||||||
|
pub contact_callsign: String,
|
||||||
|
pub stale_seconds: i64,
|
||||||
|
pub remarks: String,
|
||||||
|
}
|
||||||
|
|
||||||
|
impl FromArma for ReportMarkerCoTPayload {
|
||||||
|
fn from_arma(data: String) -> Result<ReportMarkerCoTPayload, FromArmaError> {
|
||||||
|
let (
|
||||||
|
uuid,
|
||||||
|
r#type,
|
||||||
|
point_lat,
|
||||||
|
point_lon,
|
||||||
|
point_hae,
|
||||||
|
contact_callsign,
|
||||||
|
stale_seconds,
|
||||||
|
remarks,
|
||||||
|
) = <(String, String, f64, f64, f32, String, i64, String)>::from_arma(data)?;
|
||||||
|
|
||||||
|
Ok(Self {
|
||||||
|
uuid,
|
||||||
|
r#type,
|
||||||
|
point_lat,
|
||||||
|
point_lon,
|
||||||
|
point_hae,
|
||||||
|
contact_callsign,
|
||||||
|
stale_seconds,
|
||||||
|
remarks,
|
||||||
|
})
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
impl ReportMarkerCoTPayload {
|
||||||
|
pub fn to_cot(&self) -> CursorOverTime {
|
||||||
|
CursorOverTime {
|
||||||
|
uuid: Some(self.uuid.clone()),
|
||||||
|
r#type: Some(self.r#type.clone()),
|
||||||
|
point_lat: self.point_lat,
|
||||||
|
point_lon: self.point_lon,
|
||||||
|
point_hae: self.point_hae,
|
||||||
|
point_ce: None,
|
||||||
|
point_le: None,
|
||||||
|
contact_callsign: self.contact_callsign.clone(),
|
||||||
|
group_name: None,
|
||||||
|
group_role: None,
|
||||||
|
track_course: None,
|
||||||
|
track_speed: None,
|
||||||
|
link_uid: None,
|
||||||
|
remarker: Some(self.remarks.clone()),
|
||||||
|
video_url: None,
|
||||||
|
stale_seconds: Some(self.stale_seconds),
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
#[cfg(test)]
|
||||||
|
mod tests {
|
||||||
|
use super::ReportMarkerCoTPayload;
|
||||||
|
use arma_rs::FromArma;
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn parses_report_marker_and_maps_type_remarks_and_stale_time() {
|
||||||
|
let payload = ReportMarkerCoTPayload::from_arma(
|
||||||
|
r#"["report-1","b-m-p-s-p-i",-30.1,-51.2,42.0,"SPOTREP",900,"Observed vehicle"]"#
|
||||||
|
.to_string(),
|
||||||
|
)
|
||||||
|
.expect("report marker should parse");
|
||||||
|
|
||||||
|
assert_eq!(payload.uuid, "report-1");
|
||||||
|
assert_eq!(payload.r#type, "b-m-p-s-p-i");
|
||||||
|
assert_eq!(payload.stale_seconds, 900);
|
||||||
|
assert_eq!(payload.remarks, "Observed vehicle");
|
||||||
|
|
||||||
|
let cot = payload.to_cot();
|
||||||
|
assert_eq!(cot.uuid.as_deref(), Some("report-1"));
|
||||||
|
assert_eq!(cot.r#type.as_deref(), Some("b-m-p-s-p-i"));
|
||||||
|
assert_eq!(cot.point_lat, -30.1);
|
||||||
|
assert_eq!(cot.point_lon, -51.2);
|
||||||
|
assert_eq!(cot.point_hae, 42.0);
|
||||||
|
assert_eq!(cot.contact_callsign, "SPOTREP");
|
||||||
|
assert_eq!(cot.remarker.as_deref(), Some("Observed vehicle"));
|
||||||
|
assert_eq!(cot.stale_seconds, Some(900));
|
||||||
|
assert!(cot.group_name.is_none());
|
||||||
|
assert!(cot.track_course.is_none());
|
||||||
|
assert!(cot.link_uid.is_none());
|
||||||
|
assert!(cot.video_url.is_none());
|
||||||
|
}
|
||||||
|
}
|
||||||
+458
@@ -0,0 +1,458 @@
|
|||||||
|
use super::video::video_detail_xml;
|
||||||
|
use arma_rs::{FromArma, FromArmaError};
|
||||||
|
use chrono::{Duration, SecondsFormat, Utc};
|
||||||
|
|
||||||
|
fn escape_xml(value: &str) -> String {
|
||||||
|
value
|
||||||
|
.replace('&', "&")
|
||||||
|
.replace('"', """)
|
||||||
|
.replace('<', "<")
|
||||||
|
.replace('>', ">")
|
||||||
|
.replace('\'', "'")
|
||||||
|
}
|
||||||
|
|
||||||
|
fn parse_rtsp_url(url: &str) -> Option<(String, String, String)> {
|
||||||
|
let without_proto = url.strip_prefix("rtsp://")?;
|
||||||
|
let slash_pos = without_proto.find('/')?;
|
||||||
|
let host_port = &without_proto[..slash_pos];
|
||||||
|
let path = &without_proto[slash_pos..];
|
||||||
|
let colon_pos = host_port.rfind(':')?;
|
||||||
|
let address = host_port[..colon_pos].to_string();
|
||||||
|
let port = host_port[colon_pos + 1..].to_string();
|
||||||
|
Some((address, port, path.to_string()))
|
||||||
|
}
|
||||||
|
|
||||||
|
pub struct UasPlatformCoTPayload {
|
||||||
|
pub uid: String,
|
||||||
|
pub cot_type: String,
|
||||||
|
pub callsign: String,
|
||||||
|
pub point_lat: f64,
|
||||||
|
pub point_lon: f64,
|
||||||
|
pub point_hae: f32,
|
||||||
|
pub track_course: i32,
|
||||||
|
pub track_speed: f32,
|
||||||
|
pub sensor_azimuth: i32,
|
||||||
|
pub sensor_elevation: i32,
|
||||||
|
pub sensor_fov: i32,
|
||||||
|
pub sensor_vfov: i32,
|
||||||
|
pub sensor_range: i32,
|
||||||
|
pub attitude_yaw: i32,
|
||||||
|
pub attitude_pitch: f32,
|
||||||
|
pub attitude_roll: f32,
|
||||||
|
pub hal: f32,
|
||||||
|
pub vehicle_type_tag: String,
|
||||||
|
pub is_flying: i32,
|
||||||
|
pub link_uid: String,
|
||||||
|
}
|
||||||
|
|
||||||
|
impl FromArma for UasPlatformCoTPayload {
|
||||||
|
fn from_arma(data: String) -> Result<UasPlatformCoTPayload, FromArmaError> {
|
||||||
|
let (
|
||||||
|
uid,
|
||||||
|
cot_type,
|
||||||
|
callsign,
|
||||||
|
point_lat,
|
||||||
|
point_lon,
|
||||||
|
point_hae,
|
||||||
|
track_course,
|
||||||
|
track_speed,
|
||||||
|
sensor_azimuth,
|
||||||
|
sensor_elevation,
|
||||||
|
sensor_fov,
|
||||||
|
sensor_vfov,
|
||||||
|
sensor_range,
|
||||||
|
attitude_yaw,
|
||||||
|
attitude_pitch,
|
||||||
|
attitude_roll,
|
||||||
|
hal,
|
||||||
|
vehicle_type_tag,
|
||||||
|
is_flying,
|
||||||
|
link_uid,
|
||||||
|
) = <(
|
||||||
|
String,
|
||||||
|
String,
|
||||||
|
String,
|
||||||
|
f64,
|
||||||
|
f64,
|
||||||
|
f32,
|
||||||
|
i32,
|
||||||
|
f32,
|
||||||
|
i32,
|
||||||
|
i32,
|
||||||
|
i32,
|
||||||
|
i32,
|
||||||
|
i32,
|
||||||
|
i32,
|
||||||
|
f32,
|
||||||
|
f32,
|
||||||
|
f32,
|
||||||
|
String,
|
||||||
|
i32,
|
||||||
|
String,
|
||||||
|
)>::from_arma(data)?;
|
||||||
|
|
||||||
|
Ok(Self {
|
||||||
|
uid,
|
||||||
|
cot_type,
|
||||||
|
callsign,
|
||||||
|
point_lat,
|
||||||
|
point_lon,
|
||||||
|
point_hae,
|
||||||
|
track_course,
|
||||||
|
track_speed,
|
||||||
|
sensor_azimuth,
|
||||||
|
sensor_elevation,
|
||||||
|
sensor_fov,
|
||||||
|
sensor_vfov,
|
||||||
|
sensor_range,
|
||||||
|
attitude_yaw,
|
||||||
|
attitude_pitch,
|
||||||
|
attitude_roll,
|
||||||
|
hal,
|
||||||
|
vehicle_type_tag,
|
||||||
|
is_flying,
|
||||||
|
link_uid,
|
||||||
|
})
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
impl UasPlatformCoTPayload {
|
||||||
|
pub fn to_xml(&self) -> String {
|
||||||
|
let uid = escape_xml(&self.uid);
|
||||||
|
let cot_type = escape_xml(&self.cot_type);
|
||||||
|
let callsign = escape_xml(&self.callsign);
|
||||||
|
let link_uid = escape_xml(&self.link_uid);
|
||||||
|
let (vehicle_type_tag, video_url) =
|
||||||
|
match self.vehicle_type_tag.split_once("|armatak_video_url=") {
|
||||||
|
Some((vehicle_type_tag, video_url)) => (
|
||||||
|
escape_xml(vehicle_type_tag),
|
||||||
|
Some(escape_xml(video_url.trim())).filter(|value| !value.is_empty()),
|
||||||
|
),
|
||||||
|
None => (escape_xml(&self.vehicle_type_tag), None),
|
||||||
|
};
|
||||||
|
let now = Utc::now().to_rfc3339_opts(SecondsFormat::Millis, true);
|
||||||
|
let stale = (Utc::now() + Duration::milliseconds(3500))
|
||||||
|
.to_rfc3339_opts(SecondsFormat::Millis, true);
|
||||||
|
|
||||||
|
let mut xml = String::new();
|
||||||
|
xml.push_str("<?xml version=\"1.0\" encoding=\"UTF-8\" standalone=\"yes\"?>");
|
||||||
|
xml.push_str(&format!(
|
||||||
|
"<event version=\"2.0\" uid=\"{uid}\" type=\"{cot_type}\" time=\"{now}\" start=\"{now}\" stale=\"{stale}\" how=\"m-g\" access=\"Undefined\">",
|
||||||
|
cot_type = cot_type,
|
||||||
|
uid = uid,
|
||||||
|
now = now,
|
||||||
|
stale = stale,
|
||||||
|
));
|
||||||
|
xml.push_str(&format!(
|
||||||
|
"<point lat=\"{lat}\" lon=\"{lon}\" hae=\"{hae}\" ce=\"9999999.0\" le=\"9999999.0\"/>",
|
||||||
|
lat = self.point_lat,
|
||||||
|
lon = self.point_lon,
|
||||||
|
hae = self.point_hae,
|
||||||
|
));
|
||||||
|
xml.push_str("<detail>");
|
||||||
|
xml.push_str("<_uastool extendedCot=\"true\" activeRoute=\"false\"/>");
|
||||||
|
xml.push_str(&format!(
|
||||||
|
"<track course=\"{}\" slope=\"0.0\" speed=\"{}\"/>",
|
||||||
|
self.track_course, self.track_speed,
|
||||||
|
));
|
||||||
|
xml.push_str(&format!(
|
||||||
|
"<sensor elevation=\"{}\" vfov=\"{}\" north=\"0.0\" roll=\"0.0\" range=\"{}\" azimuth=\"{}\" fov=\"{}\" type=\"r-e\" version=\"0.6\"/>",
|
||||||
|
self.sensor_elevation,
|
||||||
|
self.sensor_vfov,
|
||||||
|
self.sensor_range,
|
||||||
|
self.sensor_azimuth,
|
||||||
|
self.sensor_fov,
|
||||||
|
));
|
||||||
|
xml.push_str(&format!(
|
||||||
|
"<spatial><attitude roll=\"{}\" pitch=\"{}\" yaw=\"{}\"/><spin roll=\"0.0\" pitch=\"0.0\" yaw=\"0.0\"/></spatial>",
|
||||||
|
self.attitude_roll,
|
||||||
|
self.attitude_pitch,
|
||||||
|
self.attitude_yaw,
|
||||||
|
));
|
||||||
|
xml.push_str(&format!(
|
||||||
|
"<vehicle goHomeBatteryPercent=\"-2147483648\" hal=\"{}\" flightTimeRemaining=\"-2147483648\" typeTag=\"{}\" batteryRemainingCapacity=\"-2147483648\" isFlying=\"{}\" flightTime=\"-2147483648\" type=\"Generic\" batteryMaxCapacity=\"-2147483648\"/>",
|
||||||
|
self.hal,
|
||||||
|
vehicle_type_tag,
|
||||||
|
if self.is_flying != 0 { "true" } else { "false" },
|
||||||
|
));
|
||||||
|
xml.push_str("<_radio rssi=\"-2147483648\" gps=\"false\"/>");
|
||||||
|
xml.push_str(&format!("<contact callsign=\"{}\"/>", callsign));
|
||||||
|
xml.push_str("<waypointCollection></waypointCollection>");
|
||||||
|
xml.push_str(&format!("<_route sender=\"{}\"/>", link_uid));
|
||||||
|
xml.push_str("<commandedData climbRate=\"0.0\"/>");
|
||||||
|
if let Some(video_url) = video_url {
|
||||||
|
xml.push_str(&video_detail_xml(&video_url, &self.uid, &self.callsign));
|
||||||
|
} else {
|
||||||
|
xml.push_str("<__video></__video>");
|
||||||
|
}
|
||||||
|
xml.push_str(&format!(
|
||||||
|
"<link uid=\"{}\" type=\"a-f-G-U-C\" relation=\"p-p\" />",
|
||||||
|
link_uid
|
||||||
|
));
|
||||||
|
xml.push_str("</detail></event>");
|
||||||
|
xml
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
pub struct UasVideoCoTPayload {
|
||||||
|
pub uid: String,
|
||||||
|
pub callsign: String,
|
||||||
|
pub video_url: String,
|
||||||
|
}
|
||||||
|
|
||||||
|
impl FromArma for UasVideoCoTPayload {
|
||||||
|
fn from_arma(data: String) -> Result<UasVideoCoTPayload, FromArmaError> {
|
||||||
|
let (uid, callsign, video_url) = <(String, String, String)>::from_arma(data)?;
|
||||||
|
Ok(Self {
|
||||||
|
uid,
|
||||||
|
callsign,
|
||||||
|
video_url,
|
||||||
|
})
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
impl UasVideoCoTPayload {
|
||||||
|
pub fn to_xml(&self) -> String {
|
||||||
|
let (address, port, path) = match parse_rtsp_url(&self.video_url) {
|
||||||
|
Some(parts) => parts,
|
||||||
|
None => {
|
||||||
|
log::warn!(
|
||||||
|
"UasVideoCoTPayload: could not parse RTSP URL: {}",
|
||||||
|
self.video_url
|
||||||
|
);
|
||||||
|
return String::new();
|
||||||
|
}
|
||||||
|
};
|
||||||
|
let callsign = escape_xml(&self.callsign);
|
||||||
|
let uid = escape_xml(&self.uid);
|
||||||
|
let address = escape_xml(&address);
|
||||||
|
let path = escape_xml(&path);
|
||||||
|
|
||||||
|
let now = Utc::now().to_rfc3339_opts(SecondsFormat::Millis, true);
|
||||||
|
let stale =
|
||||||
|
(Utc::now() + Duration::seconds(3600)).to_rfc3339_opts(SecondsFormat::Millis, true);
|
||||||
|
|
||||||
|
let mut xml = String::new();
|
||||||
|
xml.push_str("<?xml version=\"1.0\" encoding=\"UTF-8\" ?>");
|
||||||
|
xml.push_str(&format!(
|
||||||
|
"<event type=\"b-i-v\" version=\"2.0\" how=\"m-g\" uid=\"{uid}\" time=\"{now}\" start=\"{now}\" stale=\"{stale}\">",
|
||||||
|
uid = uid,
|
||||||
|
now = now,
|
||||||
|
stale = stale
|
||||||
|
));
|
||||||
|
xml.push_str(
|
||||||
|
"<point lat=\"0\" lon=\"0\" hae=\"9999999.0\" ce=\"9999999.0\" le=\"9999999.0\"/>",
|
||||||
|
);
|
||||||
|
xml.push_str("<detail>");
|
||||||
|
xml.push_str("<__video>");
|
||||||
|
xml.push_str(&format!(
|
||||||
|
"<ConnectionEntry protocol=\"rtsp\" path=\"{path}\" address=\"{address}\" port=\"{port}\" uid=\"{uid}\" alias=\"{callsign}\" roverPort=\"-1\" rtspReliable=\"0\" ignoreEmbeddedKLV=\"False\" networkTimeout=\"0\" bufferTime=\"-1\"/>",
|
||||||
|
path = path,
|
||||||
|
address = address,
|
||||||
|
port = port,
|
||||||
|
uid = uid,
|
||||||
|
callsign = callsign,
|
||||||
|
));
|
||||||
|
xml.push_str("</__video>");
|
||||||
|
xml.push_str(&format!("<contact callsign=\"{}\"/>", callsign));
|
||||||
|
xml.push_str("</detail>");
|
||||||
|
xml.push_str("</event>");
|
||||||
|
xml
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
pub struct UasSensorCoTPayload {
|
||||||
|
pub uid: String,
|
||||||
|
pub video_uid: String,
|
||||||
|
pub callsign: String,
|
||||||
|
pub point_lat: f64,
|
||||||
|
pub point_lon: f64,
|
||||||
|
pub point_hae: f32,
|
||||||
|
pub azimuth: i32,
|
||||||
|
pub fov: i32,
|
||||||
|
pub range: i32,
|
||||||
|
}
|
||||||
|
|
||||||
|
impl FromArma for UasSensorCoTPayload {
|
||||||
|
fn from_arma(data: String) -> Result<UasSensorCoTPayload, FromArmaError> {
|
||||||
|
let (uid, video_uid, callsign, point_lat, point_lon, point_hae, azimuth, fov, range) =
|
||||||
|
<(String, String, String, f64, f64, f32, i32, i32, i32)>::from_arma(data)?;
|
||||||
|
Ok(Self {
|
||||||
|
uid,
|
||||||
|
video_uid,
|
||||||
|
callsign,
|
||||||
|
point_lat,
|
||||||
|
point_lon,
|
||||||
|
point_hae,
|
||||||
|
azimuth,
|
||||||
|
fov,
|
||||||
|
range,
|
||||||
|
})
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
impl UasSensorCoTPayload {
|
||||||
|
pub fn to_xml(&self) -> String {
|
||||||
|
let uid = escape_xml(&self.uid);
|
||||||
|
let video_uid = escape_xml(&self.video_uid);
|
||||||
|
let callsign = escape_xml(&self.callsign);
|
||||||
|
let now = Utc::now().to_rfc3339_opts(SecondsFormat::Millis, true);
|
||||||
|
let stale =
|
||||||
|
(Utc::now() + Duration::seconds(60)).to_rfc3339_opts(SecondsFormat::Millis, true);
|
||||||
|
|
||||||
|
let mut xml = String::new();
|
||||||
|
xml.push_str("<?xml version=\"1.0\" encoding=\"UTF-8\" ?>");
|
||||||
|
xml.push_str(&format!(
|
||||||
|
"<event type=\"b-m-p-s-p-loc\" version=\"2.0\" how=\"h-g-i-g-o\" uid=\"{uid}\" time=\"{now}\" start=\"{now}\" stale=\"{stale}\">",
|
||||||
|
uid = uid,
|
||||||
|
now = now,
|
||||||
|
stale = stale,
|
||||||
|
));
|
||||||
|
xml.push_str(&format!(
|
||||||
|
"<point lat=\"{lat}\" lon=\"{lon}\" hae=\"{hae}\" ce=\"9999999.0\" le=\"9999999.0\"/>",
|
||||||
|
lat = self.point_lat,
|
||||||
|
lon = self.point_lon,
|
||||||
|
hae = self.point_hae,
|
||||||
|
));
|
||||||
|
xml.push_str("<detail>");
|
||||||
|
xml.push_str(&format!(
|
||||||
|
"<sensor fov=\"{fov}\" fovRed=\"1\" fovGreen=\"1\" fovBlue=\"1\" fovAlpha=\"0.5372549\" displayMagneticReference=\"0\" range=\"{range}\" azimuth=\"{az}\"/>",
|
||||||
|
fov = self.fov,
|
||||||
|
range = self.range,
|
||||||
|
az = self.azimuth,
|
||||||
|
));
|
||||||
|
xml.push_str(&format!("<__video uid=\"{}\"/>", video_uid));
|
||||||
|
xml.push_str(&format!("<contact callsign=\"{}\"/>", callsign));
|
||||||
|
xml.push_str("</detail>");
|
||||||
|
xml.push_str("</event>");
|
||||||
|
xml
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
#[cfg(test)]
|
||||||
|
mod tests {
|
||||||
|
use super::{
|
||||||
|
escape_xml, parse_rtsp_url, UasPlatformCoTPayload, UasSensorCoTPayload,
|
||||||
|
UasVideoCoTPayload,
|
||||||
|
};
|
||||||
|
use arma_rs::FromArma;
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn escapes_uas_xml_values_and_parses_rtsp_components() {
|
||||||
|
assert_eq!(escape_xml("A&B\"<C>'"), "A&B"<C>'");
|
||||||
|
assert_eq!(
|
||||||
|
parse_rtsp_url("rtsp://video.example.test:8554/live/main"),
|
||||||
|
Some((
|
||||||
|
"video.example.test".to_string(),
|
||||||
|
"8554".to_string(),
|
||||||
|
"/live/main".to_string(),
|
||||||
|
))
|
||||||
|
);
|
||||||
|
assert!(parse_rtsp_url("https://video.example.test:8554/live").is_none());
|
||||||
|
assert!(parse_rtsp_url("rtsp://video.example.test:8554").is_none());
|
||||||
|
assert!(parse_rtsp_url("rtsp://video.example.test/live").is_none());
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn parses_and_serializes_uas_platform_with_embedded_video_url() {
|
||||||
|
let payload = UasPlatformCoTPayload::from_arma(
|
||||||
|
r#"["uas<&","a-f-A-M-F-Q","Falcon<&",-30.1,-51.2,100,180,12.5,90,-15,60,40,1200,181,2.5,1.5,3.2,"Quad<&|armatak_video_url=rtsp://video.example.test:8554/live",1,"operator<&"]"#
|
||||||
|
.to_string(),
|
||||||
|
)
|
||||||
|
.expect("UAS platform payload should parse");
|
||||||
|
|
||||||
|
assert_eq!(payload.uid, "uas<&");
|
||||||
|
assert_eq!(payload.vehicle_type_tag, "Quad<&|armatak_video_url=rtsp://video.example.test:8554/live");
|
||||||
|
|
||||||
|
let xml = payload.to_xml();
|
||||||
|
assert!(xml.contains("uid=\"uas<&\""));
|
||||||
|
assert!(xml.contains("typeTag=\"Quad<&\""));
|
||||||
|
assert!(xml.contains("isFlying=\"true\""));
|
||||||
|
assert!(xml.contains("<track course=\"180\" slope=\"0.0\" speed=\"12.5\"/>"));
|
||||||
|
assert!(xml.contains("<sensor elevation=\"-15\" vfov=\"40\""));
|
||||||
|
assert!(xml.contains("<attitude roll=\"1.5\" pitch=\"2.5\" yaw=\"181\"/>"));
|
||||||
|
assert!(xml.contains("<_route sender=\"operator<&\"/>"));
|
||||||
|
assert!(xml.contains("<ConnectionEntry protocol=\"rtsp\""));
|
||||||
|
assert!(xml.contains("address=\"video.example.test\""));
|
||||||
|
assert!(xml.contains("port=\"8554\""));
|
||||||
|
assert!(xml.contains("path=\"/live\""));
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn serializes_uas_platform_without_video_as_explicit_empty_video_detail() {
|
||||||
|
let payload = UasPlatformCoTPayload {
|
||||||
|
uid: "uas-2".to_string(),
|
||||||
|
cot_type: "a-f-A-M-F-Q".to_string(),
|
||||||
|
callsign: "Raven".to_string(),
|
||||||
|
point_lat: 1.0,
|
||||||
|
point_lon: 2.0,
|
||||||
|
point_hae: 3.0,
|
||||||
|
track_course: 0,
|
||||||
|
track_speed: 0.0,
|
||||||
|
sensor_azimuth: 0,
|
||||||
|
sensor_elevation: 0,
|
||||||
|
sensor_fov: 30,
|
||||||
|
sensor_vfov: 20,
|
||||||
|
sensor_range: 100,
|
||||||
|
attitude_yaw: 0,
|
||||||
|
attitude_pitch: 0.0,
|
||||||
|
attitude_roll: 0.0,
|
||||||
|
hal: 1.0,
|
||||||
|
vehicle_type_tag: "Quadrotor".to_string(),
|
||||||
|
is_flying: 0,
|
||||||
|
link_uid: "operator-2".to_string(),
|
||||||
|
};
|
||||||
|
|
||||||
|
let xml = payload.to_xml();
|
||||||
|
assert!(xml.contains("typeTag=\"Quadrotor\""));
|
||||||
|
assert!(xml.contains("isFlying=\"false\""));
|
||||||
|
assert!(xml.contains("<__video></__video>"));
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn parses_and_serializes_standalone_uas_video_event() {
|
||||||
|
let payload = UasVideoCoTPayload::from_arma(
|
||||||
|
r#"["video<&","Falcon<&","rtsp://video.example.test:8554/live/main"]"#
|
||||||
|
.to_string(),
|
||||||
|
)
|
||||||
|
.expect("UAS video payload should parse");
|
||||||
|
|
||||||
|
let xml = payload.to_xml();
|
||||||
|
assert!(xml.contains("type=\"b-i-v\""));
|
||||||
|
assert!(xml.contains("uid=\"video<&\""));
|
||||||
|
assert!(xml.contains("path=\"/live/main\""));
|
||||||
|
assert!(xml.contains("address=\"video.example.test\""));
|
||||||
|
assert!(xml.contains("port=\"8554\""));
|
||||||
|
assert!(xml.contains("alias=\"Falcon<&\""));
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn rejects_invalid_uas_video_url() {
|
||||||
|
let payload = UasVideoCoTPayload {
|
||||||
|
uid: "video-2".to_string(),
|
||||||
|
callsign: "Raven".to_string(),
|
||||||
|
video_url: "https://video.example.test/live".to_string(),
|
||||||
|
};
|
||||||
|
|
||||||
|
assert_eq!(payload.to_xml(), "");
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn parses_and_serializes_uas_sensor_event() {
|
||||||
|
let payload = UasSensorCoTPayload::from_arma(
|
||||||
|
r#"["sensor<&","video<&","Sensor<&",-30.1,-51.2,25,270,45,850]"#
|
||||||
|
.to_string(),
|
||||||
|
)
|
||||||
|
.expect("UAS sensor payload should parse");
|
||||||
|
|
||||||
|
let xml = payload.to_xml();
|
||||||
|
assert!(xml.contains("type=\"b-m-p-s-p-loc\""));
|
||||||
|
assert!(xml.contains("uid=\"sensor<&\""));
|
||||||
|
assert!(xml.contains("lat=\"-30.1\" lon=\"-51.2\" hae=\"25\""));
|
||||||
|
assert!(xml.contains("fov=\"45\""));
|
||||||
|
assert!(xml.contains("range=\"850\""));
|
||||||
|
assert!(xml.contains("azimuth=\"270\""));
|
||||||
|
assert!(xml.contains("<__video uid=\"video<&\"/>"));
|
||||||
|
assert!(xml.contains("<contact callsign=\"Sensor<&\"/>"));
|
||||||
|
}
|
||||||
|
}
|
||||||
@@ -0,0 +1,129 @@
|
|||||||
|
fn escape_xml_attribute(value: &str) -> String {
|
||||||
|
value
|
||||||
|
.replace('&', "&")
|
||||||
|
.replace('"', """)
|
||||||
|
.replace('<', "<")
|
||||||
|
.replace('>', ">")
|
||||||
|
.replace('\'', "'")
|
||||||
|
}
|
||||||
|
|
||||||
|
fn parse_video_url(url: &str) -> Option<(String, String, String, String)> {
|
||||||
|
let (protocol, rest) = url.trim().split_once("://")?;
|
||||||
|
let (authority, path) = match rest.split_once('/') {
|
||||||
|
Some((authority, path)) => (authority, format!("/{}", path)),
|
||||||
|
None => (rest, String::new()),
|
||||||
|
};
|
||||||
|
let host_port = authority
|
||||||
|
.rsplit_once('@')
|
||||||
|
.map_or(authority, |(_, host_port)| host_port);
|
||||||
|
let (address, port) = host_port.rsplit_once(':')?;
|
||||||
|
|
||||||
|
if protocol.is_empty() || address.is_empty() || port.is_empty() {
|
||||||
|
return None;
|
||||||
|
}
|
||||||
|
|
||||||
|
Some((
|
||||||
|
protocol.to_ascii_lowercase(),
|
||||||
|
address.to_string(),
|
||||||
|
port.to_string(),
|
||||||
|
path,
|
||||||
|
))
|
||||||
|
}
|
||||||
|
|
||||||
|
pub fn video_detail_xml(video_url: &str, uid: &str, callsign: &str) -> String {
|
||||||
|
let trimmed_url = video_url.trim();
|
||||||
|
if trimmed_url.is_empty() {
|
||||||
|
return "<__video></__video>".to_string();
|
||||||
|
}
|
||||||
|
|
||||||
|
let Some((protocol, address, port, path)) = parse_video_url(trimmed_url) else {
|
||||||
|
return format!("<__video url=\"{}\"/>", escape_xml_attribute(trimmed_url));
|
||||||
|
};
|
||||||
|
|
||||||
|
format!(
|
||||||
|
"<__video><ConnectionEntry protocol=\"{}\" path=\"{}\" address=\"{}\" port=\"{}\" uid=\"{}\" alias=\"{}\" roverPort=\"-1\" rtspReliable=\"0\" ignoreEmbeddedKLV=\"False\" networkTimeout=\"0\" bufferTime=\"-1\"/></__video>",
|
||||||
|
escape_xml_attribute(&protocol),
|
||||||
|
escape_xml_attribute(&path),
|
||||||
|
escape_xml_attribute(&address),
|
||||||
|
escape_xml_attribute(&port),
|
||||||
|
escape_xml_attribute(uid),
|
||||||
|
escape_xml_attribute(callsign),
|
||||||
|
)
|
||||||
|
}
|
||||||
|
|
||||||
|
#[cfg(test)]
|
||||||
|
mod tests {
|
||||||
|
use super::{escape_xml_attribute, parse_video_url, video_detail_xml};
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn escapes_xml_attribute_characters() {
|
||||||
|
assert_eq!(
|
||||||
|
escape_xml_attribute("A&B\"<C>'"),
|
||||||
|
"A&B"<C>'"
|
||||||
|
);
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn parses_video_url_with_credentials_and_path() {
|
||||||
|
assert_eq!(
|
||||||
|
parse_video_url(" RTSP://user:pass@video.example.test:8554/live/main "),
|
||||||
|
Some((
|
||||||
|
"rtsp".to_string(),
|
||||||
|
"video.example.test".to_string(),
|
||||||
|
"8554".to_string(),
|
||||||
|
"/live/main".to_string(),
|
||||||
|
))
|
||||||
|
);
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn parses_video_url_without_path() {
|
||||||
|
assert_eq!(
|
||||||
|
parse_video_url("udp://239.1.1.1:1234"),
|
||||||
|
Some((
|
||||||
|
"udp".to_string(),
|
||||||
|
"239.1.1.1".to_string(),
|
||||||
|
"1234".to_string(),
|
||||||
|
String::new(),
|
||||||
|
))
|
||||||
|
);
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn rejects_malformed_video_urls() {
|
||||||
|
assert!(parse_video_url("video.example.test:8554/live").is_none());
|
||||||
|
assert!(parse_video_url("rtsp://video.example.test/live").is_none());
|
||||||
|
assert!(parse_video_url("://video.example.test:8554/live").is_none());
|
||||||
|
assert!(parse_video_url("rtsp://:8554/live").is_none());
|
||||||
|
assert!(parse_video_url("rtsp://video.example.test:/live").is_none());
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn emits_empty_video_detail_for_blank_url() {
|
||||||
|
assert_eq!(video_detail_xml(" ", "uid", "callsign"), "<__video></__video>");
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn falls_back_to_escaped_url_for_unstructured_input() {
|
||||||
|
assert_eq!(
|
||||||
|
video_detail_xml("custom&stream\"", "uid", "callsign"),
|
||||||
|
"<__video url=\"custom&stream"\"/>"
|
||||||
|
);
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn emits_connection_entry_for_structured_video_url() {
|
||||||
|
let xml = video_detail_xml(
|
||||||
|
"RTSP://user:pass@video.example.test:8554/live?a=1&b=2",
|
||||||
|
"uas<&\"'",
|
||||||
|
"Falcon<&\"'",
|
||||||
|
);
|
||||||
|
|
||||||
|
assert!(xml.contains("protocol=\"rtsp\""));
|
||||||
|
assert!(xml.contains("address=\"video.example.test\""));
|
||||||
|
assert!(xml.contains("port=\"8554\""));
|
||||||
|
assert!(xml.contains("path=\"/live?a=1&b=2\""));
|
||||||
|
assert!(xml.contains("uid=\"uas<&"'\""));
|
||||||
|
assert!(xml.contains("alias=\"Falcon<&"'\""));
|
||||||
|
}
|
||||||
|
}
|
||||||
+33
-2
@@ -1,8 +1,10 @@
|
|||||||
use arma_rs::{arma, Extension, Group};
|
use arma_rs::{arma, Extension, Group};
|
||||||
use rustls::crypto::aws_lc_rs;
|
use rustls::crypto::aws_lc_rs;
|
||||||
|
mod mdns;
|
||||||
mod structs;
|
mod structs;
|
||||||
mod tcp;
|
mod tcp;
|
||||||
mod tests;
|
mod tests;
|
||||||
|
mod uas;
|
||||||
mod udp_socket;
|
mod udp_socket;
|
||||||
mod video_stream;
|
mod video_stream;
|
||||||
|
|
||||||
@@ -39,12 +41,35 @@ pub fn init() -> Extension {
|
|||||||
.command("local_ip", utils::address::get_local_address)
|
.command("local_ip", utils::address::get_local_address)
|
||||||
.command("uuid", utils::uuid::get_uuid)
|
.command("uuid", utils::uuid::get_uuid)
|
||||||
.command("log", utils::log::log_info)
|
.command("log", utils::log::log_info)
|
||||||
|
.group(
|
||||||
|
"uas",
|
||||||
|
Group::new()
|
||||||
|
.command("start_endpoint", uas::start_endpoint)
|
||||||
|
.command("stop_endpoint", uas::stop_endpoint)
|
||||||
|
.command("send_uas_telemetry", uas::send_uas_telemetry)
|
||||||
|
.command("send_uas_system", uas::send_uas_system),
|
||||||
|
)
|
||||||
|
.group(
|
||||||
|
"mdns",
|
||||||
|
Group::new()
|
||||||
|
.command("start_uas_advertisement", mdns::start_uas_advertisement)
|
||||||
|
.command("stop", mdns::stop),
|
||||||
|
)
|
||||||
.group(
|
.group(
|
||||||
"udp_socket",
|
"udp_socket",
|
||||||
Group::new()
|
Group::new()
|
||||||
.command("start", udp_socket::start)
|
.command("start", udp_socket::start)
|
||||||
|
.command("start_lrf", udp_socket::start_lrf)
|
||||||
|
.command("start_cot", udp_socket::start_cot)
|
||||||
.command("send_payload", udp_socket::send_payload)
|
.command("send_payload", udp_socket::send_payload)
|
||||||
.command("send_gps_cot", udp_socket::send_gps_cot)
|
.command("send_gps_cot", udp_socket::send_gps_cot)
|
||||||
|
.command("send_eud_cot", udp_socket::send_eud_cot)
|
||||||
|
.command("send_lrf", udp_socket::send_lrf)
|
||||||
|
.command("clear_lrf", udp_socket::clear_lrf)
|
||||||
|
.command(
|
||||||
|
"send_digital_pointer_cot",
|
||||||
|
udp_socket::send_digital_pointer_cot,
|
||||||
|
)
|
||||||
.command("stop", udp_socket::stop),
|
.command("stop", udp_socket::stop),
|
||||||
)
|
)
|
||||||
.group(
|
.group(
|
||||||
@@ -60,8 +85,13 @@ pub fn init() -> Extension {
|
|||||||
Group::new()
|
Group::new()
|
||||||
.command("eud", tcp::cot::send_eud_cot)
|
.command("eud", tcp::cot::send_eud_cot)
|
||||||
.command("marker", tcp::cot::send_marker_cot)
|
.command("marker", tcp::cot::send_marker_cot)
|
||||||
|
.command("report_marker", tcp::cot::send_report_marker_cot)
|
||||||
.command("digital_pointer", tcp::cot::send_digital_pointer_cot)
|
.command("digital_pointer", tcp::cot::send_digital_pointer_cot)
|
||||||
.command("chat", tcp::cot::send_message_cot),
|
.command("delete", tcp::cot::send_delete_cot)
|
||||||
|
.command("chat", tcp::cot::send_message_cot)
|
||||||
|
.command("uas_platform", tcp::cot::send_uas_platform_cot)
|
||||||
|
.command("uas_video", tcp::cot::send_uas_video_cot)
|
||||||
|
.command("uas_sensor", tcp::cot::send_uas_sensor_cot),
|
||||||
)
|
)
|
||||||
.group(
|
.group(
|
||||||
"draw",
|
"draw",
|
||||||
@@ -70,7 +100,8 @@ pub fn init() -> Extension {
|
|||||||
.command("ellipse", tcp::draw::send_ellipse_cot)
|
.command("ellipse", tcp::draw::send_ellipse_cot)
|
||||||
.command("rectangle", tcp::draw::send_rectangle_cot)
|
.command("rectangle", tcp::draw::send_rectangle_cot)
|
||||||
.command("free", tcp::draw::send_freedraw_cot)
|
.command("free", tcp::draw::send_freedraw_cot)
|
||||||
.command("vector", tcp::draw::send_vectordraw_cot),
|
.command("vector", tcp::draw::send_vectordraw_cot)
|
||||||
|
.command("route", tcp::draw::send_route_cot),
|
||||||
),
|
),
|
||||||
)
|
)
|
||||||
.group(
|
.group(
|
||||||
|
|||||||
+229
@@ -0,0 +1,229 @@
|
|||||||
|
use arma_rs::Context;
|
||||||
|
use lazy_static::lazy_static;
|
||||||
|
use log::info;
|
||||||
|
use std::net::{Ipv4Addr, SocketAddrV4, UdpSocket};
|
||||||
|
use std::sync::mpsc::{self, Receiver, Sender};
|
||||||
|
use std::sync::Mutex;
|
||||||
|
use std::thread;
|
||||||
|
use std::time::Duration;
|
||||||
|
|
||||||
|
lazy_static! {
|
||||||
|
static ref MDNS_CTRL: Mutex<Option<Sender<()>>> = Mutex::new(None);
|
||||||
|
}
|
||||||
|
|
||||||
|
fn detect_local_ipv4() -> Result<Ipv4Addr, String> {
|
||||||
|
let socket = UdpSocket::bind("0.0.0.0:0").map_err(|e| e.to_string())?;
|
||||||
|
socket.connect("8.8.8.8:80").map_err(|e| e.to_string())?;
|
||||||
|
match socket.local_addr().map_err(|e| e.to_string())? {
|
||||||
|
std::net::SocketAddr::V4(addr) => Ok(*addr.ip()),
|
||||||
|
std::net::SocketAddr::V6(_) => Err("Local address is not IPv4".to_string()),
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
fn sanitize_label(value: &str, fallback: &str) -> String {
|
||||||
|
let mut sanitized = value
|
||||||
|
.chars()
|
||||||
|
.map(|c| {
|
||||||
|
if c.is_ascii_alphanumeric() || c == '-' {
|
||||||
|
c
|
||||||
|
} else {
|
||||||
|
'-'
|
||||||
|
}
|
||||||
|
})
|
||||||
|
.collect::<String>()
|
||||||
|
.trim_matches('-')
|
||||||
|
.to_string();
|
||||||
|
|
||||||
|
if sanitized.is_empty() {
|
||||||
|
sanitized = fallback.to_string();
|
||||||
|
}
|
||||||
|
|
||||||
|
if sanitized.len() > 63 {
|
||||||
|
sanitized.truncate(63);
|
||||||
|
}
|
||||||
|
|
||||||
|
sanitized
|
||||||
|
}
|
||||||
|
|
||||||
|
fn encode_name(name: &str) -> Vec<u8> {
|
||||||
|
let mut encoded = Vec::new();
|
||||||
|
for label in name.split('.') {
|
||||||
|
let bytes = label.as_bytes();
|
||||||
|
encoded.push(bytes.len() as u8);
|
||||||
|
encoded.extend_from_slice(bytes);
|
||||||
|
}
|
||||||
|
encoded.push(0);
|
||||||
|
encoded
|
||||||
|
}
|
||||||
|
|
||||||
|
fn push_u16(buf: &mut Vec<u8>, value: u16) {
|
||||||
|
buf.extend_from_slice(&value.to_be_bytes());
|
||||||
|
}
|
||||||
|
|
||||||
|
fn push_u32(buf: &mut Vec<u8>, value: u32) {
|
||||||
|
buf.extend_from_slice(&value.to_be_bytes());
|
||||||
|
}
|
||||||
|
|
||||||
|
fn push_record(buf: &mut Vec<u8>, name: &str, rr_type: u16, rr_class: u16, ttl: u32, rdata: &[u8]) {
|
||||||
|
buf.extend_from_slice(&encode_name(name));
|
||||||
|
push_u16(buf, rr_type);
|
||||||
|
push_u16(buf, rr_class);
|
||||||
|
push_u32(buf, ttl);
|
||||||
|
push_u16(buf, rdata.len() as u16);
|
||||||
|
buf.extend_from_slice(rdata);
|
||||||
|
}
|
||||||
|
|
||||||
|
fn build_mdns_packet(
|
||||||
|
instance_name: &str,
|
||||||
|
host_name: &str,
|
||||||
|
ip: Ipv4Addr,
|
||||||
|
port: u16,
|
||||||
|
video_uri: &str,
|
||||||
|
) -> Vec<u8> {
|
||||||
|
let service_type = "_mavlink._udp.local";
|
||||||
|
let instance_fqdn = format!("{}.{}", instance_name, service_type);
|
||||||
|
let host_fqdn = format!("{}.local", host_name);
|
||||||
|
|
||||||
|
let mut packet = Vec::new();
|
||||||
|
push_u16(&mut packet, 0);
|
||||||
|
push_u16(&mut packet, 0x8400);
|
||||||
|
push_u16(&mut packet, 0);
|
||||||
|
push_u16(&mut packet, 4);
|
||||||
|
push_u16(&mut packet, 0);
|
||||||
|
push_u16(&mut packet, 0);
|
||||||
|
|
||||||
|
let ptr_rdata = encode_name(&instance_fqdn);
|
||||||
|
push_record(&mut packet, service_type, 12, 0x0001, 120, &ptr_rdata);
|
||||||
|
|
||||||
|
let mut srv_rdata = Vec::new();
|
||||||
|
push_u16(&mut srv_rdata, 0);
|
||||||
|
push_u16(&mut srv_rdata, 0);
|
||||||
|
push_u16(&mut srv_rdata, port);
|
||||||
|
srv_rdata.extend_from_slice(&encode_name(&host_fqdn));
|
||||||
|
push_record(&mut packet, &instance_fqdn, 33, 0x8001, 120, &srv_rdata);
|
||||||
|
|
||||||
|
let txt_value = format!("uri={}", video_uri);
|
||||||
|
let txt_bytes = txt_value.as_bytes();
|
||||||
|
let mut txt_rdata = Vec::new();
|
||||||
|
txt_rdata.push(txt_bytes.len() as u8);
|
||||||
|
txt_rdata.extend_from_slice(txt_bytes);
|
||||||
|
push_record(&mut packet, &instance_fqdn, 16, 0x8001, 120, &txt_rdata);
|
||||||
|
|
||||||
|
let a_rdata = ip.octets();
|
||||||
|
push_record(&mut packet, &host_fqdn, 1, 0x8001, 120, &a_rdata);
|
||||||
|
|
||||||
|
packet
|
||||||
|
}
|
||||||
|
|
||||||
|
fn stop_existing() {
|
||||||
|
if let Ok(mut lock) = MDNS_CTRL.lock() {
|
||||||
|
if let Some(tx) = lock.take() {
|
||||||
|
let _ = tx.send(());
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
pub fn start_uas_advertisement(
|
||||||
|
ctx: Context,
|
||||||
|
instance_name: String,
|
||||||
|
mavlink_port: i32,
|
||||||
|
video_uri: String,
|
||||||
|
) -> &'static str {
|
||||||
|
stop_existing();
|
||||||
|
|
||||||
|
let local_ip = match detect_local_ipv4() {
|
||||||
|
Ok(ip) => ip,
|
||||||
|
Err(error) => {
|
||||||
|
let _ = ctx.callback_data(
|
||||||
|
"MDNS ERROR",
|
||||||
|
"Failed to determine local IPv4",
|
||||||
|
error.clone(),
|
||||||
|
);
|
||||||
|
return "mdns local IPv4 error";
|
||||||
|
}
|
||||||
|
};
|
||||||
|
|
||||||
|
let port = mavlink_port.clamp(1, 65535) as u16;
|
||||||
|
let safe_instance = sanitize_label(&instance_name, "ArmaTAK-UAS");
|
||||||
|
let host_label = sanitize_label(
|
||||||
|
&format!("armatak-{}", safe_instance.to_lowercase()),
|
||||||
|
"armatak-uas-host",
|
||||||
|
);
|
||||||
|
let packet = build_mdns_packet(&safe_instance, &host_label, local_ip, port, &video_uri);
|
||||||
|
let callback_video_uri = video_uri.clone();
|
||||||
|
let multicast_addr = SocketAddrV4::new(Ipv4Addr::new(224, 0, 0, 251), 5353);
|
||||||
|
|
||||||
|
let (stop_tx, stop_rx): (Sender<()>, Receiver<()>) = mpsc::channel();
|
||||||
|
if let Ok(mut lock) = MDNS_CTRL.lock() {
|
||||||
|
*lock = Some(stop_tx);
|
||||||
|
}
|
||||||
|
|
||||||
|
thread::spawn(move || {
|
||||||
|
let socket = match UdpSocket::bind("0.0.0.0:0") {
|
||||||
|
Ok(socket) => socket,
|
||||||
|
Err(error) => {
|
||||||
|
info!("mDNS failed to bind UDP socket: {}", error);
|
||||||
|
return;
|
||||||
|
}
|
||||||
|
};
|
||||||
|
|
||||||
|
let _ = socket.set_multicast_ttl_v4(255);
|
||||||
|
let _ = socket.set_multicast_loop_v4(true);
|
||||||
|
|
||||||
|
info!(
|
||||||
|
"Starting mDNS UAS advertisement instance={} host={} ip={} port={} video_uri={}",
|
||||||
|
safe_instance, host_label, local_ip, port, video_uri
|
||||||
|
);
|
||||||
|
|
||||||
|
loop {
|
||||||
|
match socket.send_to(&packet, multicast_addr) {
|
||||||
|
Ok(size) => info!(
|
||||||
|
"Sent mDNS UAS advertisement ({} bytes) to {}",
|
||||||
|
size, multicast_addr
|
||||||
|
),
|
||||||
|
Err(error) => info!("Failed sending mDNS UAS advertisement: {}", error),
|
||||||
|
}
|
||||||
|
|
||||||
|
match stop_rx.recv_timeout(Duration::from_secs(5)) {
|
||||||
|
Ok(_) => break,
|
||||||
|
Err(mpsc::RecvTimeoutError::Timeout) => {}
|
||||||
|
Err(_) => break,
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
info!(
|
||||||
|
"Stopped mDNS UAS advertisement for instance={}",
|
||||||
|
safe_instance
|
||||||
|
);
|
||||||
|
});
|
||||||
|
|
||||||
|
let _ = ctx.callback_data(
|
||||||
|
"MDNS",
|
||||||
|
"UAS advertisement started",
|
||||||
|
format!("{}:{} | {}", local_ip, port, callback_video_uri),
|
||||||
|
);
|
||||||
|
|
||||||
|
"starting mdns uas advertisement"
|
||||||
|
}
|
||||||
|
|
||||||
|
pub fn stop(ctx: Context) -> &'static str {
|
||||||
|
let had_running = match MDNS_CTRL.lock() {
|
||||||
|
Ok(mut lock) => {
|
||||||
|
if let Some(tx) = lock.take() {
|
||||||
|
let _ = tx.send(());
|
||||||
|
true
|
||||||
|
} else {
|
||||||
|
false
|
||||||
|
}
|
||||||
|
}
|
||||||
|
Err(_) => false,
|
||||||
|
};
|
||||||
|
|
||||||
|
if had_running {
|
||||||
|
let _ = ctx.callback_null("MDNS", "UAS advertisement stopped");
|
||||||
|
"stopping mdns advertisement"
|
||||||
|
} else {
|
||||||
|
let _ = ctx.callback_null("MDNS ERROR", "No mDNS advertisement is running");
|
||||||
|
"no mdns advertisement running"
|
||||||
|
}
|
||||||
|
}
|
||||||
+17
-14
@@ -54,17 +54,15 @@ fn send_over_stream(
|
|||||||
) -> Result<(), String> {
|
) -> Result<(), String> {
|
||||||
let message_len = message.len();
|
let message_len = message.len();
|
||||||
info!("Sending TCP payload ({} bytes)", message_len);
|
info!("Sending TCP payload ({} bytes)", message_len);
|
||||||
stream
|
stream.write_message(message.as_bytes()).map_err(|e| {
|
||||||
.write_message(message.as_bytes())
|
let message = e.to_string();
|
||||||
.map_err(|e| {
|
let _ = context.callback_data(
|
||||||
let message = e.to_string();
|
"TCP SOCKET ERROR",
|
||||||
let _ = context.callback_data(
|
"TAK Socket disconnected",
|
||||||
"TCP SOCKET ERROR",
|
message.clone(),
|
||||||
"TAK Socket disconnected",
|
);
|
||||||
message.clone(),
|
message
|
||||||
);
|
})
|
||||||
message
|
|
||||||
})
|
|
||||||
}
|
}
|
||||||
|
|
||||||
fn flush_pending_messages(
|
fn flush_pending_messages(
|
||||||
@@ -145,10 +143,14 @@ impl TcpClient {
|
|||||||
let mut pending_messages: VecDeque<(String, Context)> = VecDeque::new();
|
let mut pending_messages: VecDeque<(String, Context)> = VecDeque::new();
|
||||||
let (connect_tx, connect_rx) = mpsc::channel();
|
let (connect_tx, connect_rx) = mpsc::channel();
|
||||||
|
|
||||||
info!("TCP worker thread started with config: {}", config_description);
|
info!(
|
||||||
|
"TCP worker thread started with config: {}",
|
||||||
|
config_description
|
||||||
|
);
|
||||||
|
|
||||||
let tcp_thread = thread::spawn(move || {
|
let tcp_thread = thread::spawn(move || {
|
||||||
let connect_result = panic::catch_unwind(AssertUnwindSafe(|| connect_stream(&config)));
|
let connect_result =
|
||||||
|
panic::catch_unwind(AssertUnwindSafe(|| connect_stream(&config)));
|
||||||
|
|
||||||
match connect_result {
|
match connect_result {
|
||||||
Ok(Ok(stream)) => {
|
Ok(Ok(stream)) => {
|
||||||
@@ -184,7 +186,8 @@ impl TcpClient {
|
|||||||
match &mut state {
|
match &mut state {
|
||||||
ConnectionState::Connected => {
|
ConnectionState::Connected => {
|
||||||
if let Some(stream) = connection.as_mut() {
|
if let Some(stream) = connection.as_mut() {
|
||||||
if let Err(error) = send_over_stream(stream, &context, message) {
|
if let Err(error) = send_over_stream(stream, &context, message)
|
||||||
|
{
|
||||||
info!("Failed to send message: {}", error);
|
info!("Failed to send message: {}", error);
|
||||||
state = ConnectionState::Failed(error);
|
state = ConnectionState::Failed(error);
|
||||||
connection = None;
|
connection = None;
|
||||||
|
|||||||
@@ -62,3 +62,65 @@ impl ConnectionConfig {
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
#[cfg(test)]
|
||||||
|
mod tests {
|
||||||
|
use super::ConnectionConfig;
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn describes_plain_tcp_connection() {
|
||||||
|
let config = ConnectionConfig::Plain {
|
||||||
|
address: "127.0.0.1:8087".to_string(),
|
||||||
|
};
|
||||||
|
|
||||||
|
assert_eq!(config.connected_message(), "Connected to TCP Server");
|
||||||
|
assert_eq!(config.target(), "127.0.0.1:8087");
|
||||||
|
assert_eq!(config.describe(), "plain tcp -> 127.0.0.1:8087");
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn describes_manual_mtls_connection() {
|
||||||
|
let config = ConnectionConfig::Mtls {
|
||||||
|
address: "tak.example.test:8089".to_string(),
|
||||||
|
server_name: "tak.example.test".to_string(),
|
||||||
|
ca_cert_path: "ca.pem".to_string(),
|
||||||
|
client_cert_path: "client.pem".to_string(),
|
||||||
|
client_key_path: "client.key".to_string(),
|
||||||
|
};
|
||||||
|
|
||||||
|
assert_eq!(
|
||||||
|
config.connected_message(),
|
||||||
|
"Connected to TAK Server via mTLS"
|
||||||
|
);
|
||||||
|
assert_eq!(config.target(), "tak.example.test:8089");
|
||||||
|
assert_eq!(
|
||||||
|
config.describe(),
|
||||||
|
"manual mtls -> tak.example.test:8089 (server_name=tak.example.test, ca=ca.pem, cert=client.pem, key=client.key)"
|
||||||
|
);
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn enrollment_description_excludes_password() {
|
||||||
|
let config = ConnectionConfig::EnrollMtls {
|
||||||
|
host: "tak.example.test".to_string(),
|
||||||
|
server_name: "tak.example.test".to_string(),
|
||||||
|
enroll_port: "8446".to_string(),
|
||||||
|
username: "operator".to_string(),
|
||||||
|
password: "super-secret-password".to_string(),
|
||||||
|
client_uid: "armatak-test".to_string(),
|
||||||
|
};
|
||||||
|
|
||||||
|
assert_eq!(
|
||||||
|
config.connected_message(),
|
||||||
|
"Connected to TAK Server via enrolled mTLS certificate"
|
||||||
|
);
|
||||||
|
assert_eq!(config.target(), "tak.example.test");
|
||||||
|
|
||||||
|
let description = config.describe();
|
||||||
|
assert_eq!(
|
||||||
|
description,
|
||||||
|
"enroll mtls -> host=tak.example.test enroll_port=8446 server_name=tak.example.test username=operator client_uid=armatak-test"
|
||||||
|
);
|
||||||
|
assert!(!description.contains("super-secret-password"));
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|||||||
@@ -19,6 +19,16 @@ pub fn send_marker_cot(
|
|||||||
"Sending Marker Cursor Over Time to TCP server"
|
"Sending Marker Cursor Over Time to TCP server"
|
||||||
}
|
}
|
||||||
|
|
||||||
|
pub fn send_report_marker_cot(
|
||||||
|
ctx: Context,
|
||||||
|
cursor_over_time: cot::report_marker::ReportMarkerCoTPayload,
|
||||||
|
) -> &'static str {
|
||||||
|
let payload = cursor_over_time.to_cot().convert_to_xml();
|
||||||
|
send_payload(ctx, payload);
|
||||||
|
|
||||||
|
"Sending Report Marker Cursor Over Time to TCP server"
|
||||||
|
}
|
||||||
|
|
||||||
pub fn send_digital_pointer_cot(
|
pub fn send_digital_pointer_cot(
|
||||||
ctx: Context,
|
ctx: Context,
|
||||||
cursor_over_time: cot::digital_pointer::DigitalPointerPayload,
|
cursor_over_time: cot::digital_pointer::DigitalPointerPayload,
|
||||||
@@ -29,6 +39,12 @@ pub fn send_digital_pointer_cot(
|
|||||||
"Sending Digital Pointer Cursor Over Time to TCP server"
|
"Sending Digital Pointer Cursor Over Time to TCP server"
|
||||||
}
|
}
|
||||||
|
|
||||||
|
pub fn send_delete_cot(ctx: Context, payload: cot::delete::DeleteCoTPayload) -> &'static str {
|
||||||
|
send_payload(ctx, payload.to_xml());
|
||||||
|
|
||||||
|
"Sending Delete Cursor Over Time to TCP server"
|
||||||
|
}
|
||||||
|
|
||||||
pub fn send_message_cot(
|
pub fn send_message_cot(
|
||||||
ctx: Context,
|
ctx: Context,
|
||||||
message_payload: cot::message::MessagePayload,
|
message_payload: cot::message::MessagePayload,
|
||||||
@@ -39,3 +55,29 @@ pub fn send_message_cot(
|
|||||||
|
|
||||||
"Sending Message CoT to TCP server"
|
"Sending Message CoT to TCP server"
|
||||||
}
|
}
|
||||||
|
|
||||||
|
pub fn send_uas_platform_cot(
|
||||||
|
ctx: Context,
|
||||||
|
payload: cot::uas::UasPlatformCoTPayload,
|
||||||
|
) -> &'static str {
|
||||||
|
let xml = payload.to_xml();
|
||||||
|
send_payload(ctx, xml);
|
||||||
|
|
||||||
|
"Sending UAS Platform main CoT to TCP server"
|
||||||
|
}
|
||||||
|
|
||||||
|
pub fn send_uas_video_cot(ctx: Context, payload: cot::uas::UasVideoCoTPayload) -> &'static str {
|
||||||
|
let xml = payload.to_xml();
|
||||||
|
if !xml.is_empty() {
|
||||||
|
send_payload(ctx, xml);
|
||||||
|
}
|
||||||
|
|
||||||
|
"Sending UAS Video (b-i-v) CoT to TCP server"
|
||||||
|
}
|
||||||
|
|
||||||
|
pub fn send_uas_sensor_cot(ctx: Context, payload: cot::uas::UasSensorCoTPayload) -> &'static str {
|
||||||
|
let xml = payload.to_xml();
|
||||||
|
send_payload(ctx, xml);
|
||||||
|
|
||||||
|
"Sending UAS Sensor (b-m-p-s-p-loc) CoT to TCP server"
|
||||||
|
}
|
||||||
|
|||||||
+68
-15
@@ -1,37 +1,90 @@
|
|||||||
use arma_rs::Context;
|
use arma_rs::Context;
|
||||||
|
use log::info;
|
||||||
|
|
||||||
use crate::{cot, tcp::send_payload};
|
use crate::{cot, tcp::send_payload};
|
||||||
|
|
||||||
|
fn day_stale() -> (String, String) {
|
||||||
|
let now = chrono::Utc::now().to_rfc3339_opts(chrono::SecondsFormat::Millis, true);
|
||||||
|
let stale = (chrono::Utc::now() + chrono::Duration::days(1))
|
||||||
|
.to_rfc3339_opts(chrono::SecondsFormat::Millis, true);
|
||||||
|
(now, stale)
|
||||||
|
}
|
||||||
|
|
||||||
|
fn payload_stale(stale_seconds: i64) -> (String, String) {
|
||||||
|
let now = chrono::Utc::now().to_rfc3339_opts(chrono::SecondsFormat::Millis, true);
|
||||||
|
let stale = (chrono::Utc::now() + chrono::Duration::seconds(stale_seconds.max(1)))
|
||||||
|
.to_rfc3339_opts(chrono::SecondsFormat::Millis, true);
|
||||||
|
(now, stale)
|
||||||
|
}
|
||||||
|
|
||||||
pub fn send_circle_cot(
|
pub fn send_circle_cot(
|
||||||
ctx: Context,
|
ctx: Context,
|
||||||
circle_payload: cot::draws::circle::CircleCoTPayload,
|
circle_payload: cot::draws::circle::CircleCoTPayload,
|
||||||
) -> &'static str {
|
) -> &'static str {
|
||||||
let shape_circle_cot = circle_payload.to_cot();
|
let shape_circle_cot = circle_payload.to_cot();
|
||||||
let now = chrono::Utc::now().to_rfc3339_opts(chrono::SecondsFormat::Millis, true);
|
let (now, stale) = day_stale();
|
||||||
let stale = (chrono::Utc::now() + chrono::Duration::days(1))
|
|
||||||
.to_rfc3339_opts(chrono::SecondsFormat::Millis, true);
|
|
||||||
let payload = shape_circle_cot.to_xml(&now, &stale);
|
let payload = shape_circle_cot.to_xml(&now, &stale);
|
||||||
send_payload(ctx, payload);
|
send_payload(ctx, payload);
|
||||||
|
|
||||||
"Sending Circle CoT to TCP server"
|
"Sending Circle CoT to TCP server"
|
||||||
}
|
}
|
||||||
|
|
||||||
pub fn send_ellipse_cot(ctx: Context) -> &'static str {
|
pub fn send_ellipse_cot(
|
||||||
let _ = ctx;
|
ctx: Context,
|
||||||
"Not implemented: send_ellipse_cot"
|
ellipse_payload: cot::draws::shape::DrawEllipsePayload,
|
||||||
|
) -> &'static str {
|
||||||
|
let (now, stale) = payload_stale(ellipse_payload.stale_seconds);
|
||||||
|
let payload = ellipse_payload.to_xml(&now, &stale);
|
||||||
|
send_payload(ctx, payload);
|
||||||
|
|
||||||
|
"Sending Ellipse CoT to TCP server"
|
||||||
}
|
}
|
||||||
|
|
||||||
pub fn send_rectangle_cot(ctx: Context) -> &'static str {
|
pub fn send_rectangle_cot(
|
||||||
let _ = ctx;
|
ctx: Context,
|
||||||
"Not implemented: send_ellipse_cot"
|
rectangle_payload: cot::draws::shape::DrawLinksPayload,
|
||||||
|
) -> &'static str {
|
||||||
|
let (now, stale) = payload_stale(rectangle_payload.stale_seconds);
|
||||||
|
let payload = rectangle_payload.to_xml(&now, &stale);
|
||||||
|
send_payload(ctx, payload);
|
||||||
|
|
||||||
|
"Sending Rectangle CoT to TCP server"
|
||||||
}
|
}
|
||||||
|
|
||||||
pub fn send_freedraw_cot(ctx: Context) -> &'static str {
|
pub fn send_freedraw_cot(
|
||||||
let _ = ctx;
|
ctx: Context,
|
||||||
"Not implemented: send_ellipse_cot"
|
freedraw_payload: cot::draws::shape::DrawLinksPayload,
|
||||||
|
) -> &'static str {
|
||||||
|
let (now, stale) = payload_stale(freedraw_payload.stale_seconds);
|
||||||
|
let payload = freedraw_payload.to_xml(&now, &stale);
|
||||||
|
send_payload(ctx, payload);
|
||||||
|
|
||||||
|
"Sending Free Draw CoT to TCP server"
|
||||||
}
|
}
|
||||||
|
|
||||||
pub fn send_vectordraw_cot(ctx: Context) -> &'static str {
|
pub fn send_vectordraw_cot(
|
||||||
let _ = ctx;
|
ctx: Context,
|
||||||
"Not implemented: send_ellipse_cot"
|
vector_payload: cot::draws::shape::DrawLinksPayload,
|
||||||
|
) -> &'static str {
|
||||||
|
let (now, stale) = payload_stale(vector_payload.stale_seconds);
|
||||||
|
let payload = vector_payload.to_xml(&now, &stale);
|
||||||
|
send_payload(ctx, payload);
|
||||||
|
|
||||||
|
"Sending Tactical Graphic CoT to TCP server"
|
||||||
|
}
|
||||||
|
|
||||||
|
pub fn send_route_cot(
|
||||||
|
ctx: Context,
|
||||||
|
route_payload: cot::draws::route::RoutePayload,
|
||||||
|
) -> &'static str {
|
||||||
|
let (now, stale) = payload_stale(route_payload.stale_seconds);
|
||||||
|
let payload = route_payload.to_xml(&now, &stale);
|
||||||
|
info!(
|
||||||
|
"Sending ATAK route '{}' ({} bytes)",
|
||||||
|
route_payload.callsign,
|
||||||
|
payload.len()
|
||||||
|
);
|
||||||
|
send_payload(ctx, payload);
|
||||||
|
|
||||||
|
"Sending Route CoT to TCP server"
|
||||||
}
|
}
|
||||||
|
|||||||
@@ -6,8 +6,8 @@ use std::fs::File;
|
|||||||
use std::io::BufReader;
|
use std::io::BufReader;
|
||||||
use std::io::Cursor;
|
use std::io::Cursor;
|
||||||
use std::net::{SocketAddr, TcpStream, ToSocketAddrs};
|
use std::net::{SocketAddr, TcpStream, ToSocketAddrs};
|
||||||
use std::time::Duration;
|
|
||||||
use std::sync::Arc;
|
use std::sync::Arc;
|
||||||
|
use std::time::Duration;
|
||||||
|
|
||||||
use crate::tcp::transport::TransportStream;
|
use crate::tcp::transport::TransportStream;
|
||||||
|
|
||||||
@@ -65,7 +65,12 @@ fn resolve_address(address: &str) -> Result<SocketAddr, String> {
|
|||||||
.to_socket_addrs()
|
.to_socket_addrs()
|
||||||
.map_err(|e| format!("failed to resolve {}: {}", address, e))?
|
.map_err(|e| format!("failed to resolve {}: {}", address, e))?
|
||||||
.next()
|
.next()
|
||||||
.ok_or_else(|| format!("failed to resolve {}: no socket addresses returned", address))
|
.ok_or_else(|| {
|
||||||
|
format!(
|
||||||
|
"failed to resolve {}: no socket addresses returned",
|
||||||
|
address
|
||||||
|
)
|
||||||
|
})
|
||||||
}
|
}
|
||||||
|
|
||||||
fn connect_tcp(address: &str) -> Result<TcpStream, String> {
|
fn connect_tcp(address: &str) -> Result<TcpStream, String> {
|
||||||
|
|||||||
+22
-63
@@ -1,10 +1,14 @@
|
|||||||
use rcgen::{CertificateParams, DistinguishedName, DnType, KeyPair, PKCS_RSA_SHA256};
|
|
||||||
use log::info;
|
use log::info;
|
||||||
|
use rcgen::{CertificateParams, DistinguishedName, DnType, KeyPair, PKCS_RSA_SHA256};
|
||||||
use reqwest::blocking::Client;
|
use reqwest::blocking::Client;
|
||||||
use serde::Deserialize;
|
use serde::Deserialize;
|
||||||
use uuid::Uuid;
|
use uuid::Uuid;
|
||||||
|
|
||||||
use super::connector::connect_mtls_from_pem;
|
use super::connector::connect_mtls_from_pem;
|
||||||
|
use super::protocol::{
|
||||||
|
enrollment_config_url, enrollment_sign_url, normalize_certificate_pem,
|
||||||
|
parse_enrollment_config, EnrollmentConfig,
|
||||||
|
};
|
||||||
use crate::tcp::transport::TransportStream;
|
use crate::tcp::transport::TransportStream;
|
||||||
|
|
||||||
#[derive(Deserialize)]
|
#[derive(Deserialize)]
|
||||||
@@ -14,34 +18,6 @@ struct EnrollmentResponse {
|
|||||||
ca0: String,
|
ca0: String,
|
||||||
}
|
}
|
||||||
|
|
||||||
struct EnrollmentConfig {
|
|
||||||
server_port: String,
|
|
||||||
enroll_path: String,
|
|
||||||
}
|
|
||||||
|
|
||||||
fn extract_tag_value(xml: &str, tag_name: &str) -> Option<String> {
|
|
||||||
let open_tag = format!("<{}>", tag_name);
|
|
||||||
let close_tag = format!("</{}>", tag_name);
|
|
||||||
let start = xml.find(&open_tag)? + open_tag.len();
|
|
||||||
let end = xml[start..].find(&close_tag)? + start;
|
|
||||||
Some(xml[start..end].trim().to_string())
|
|
||||||
}
|
|
||||||
|
|
||||||
fn wrap_pem_body(base64_body: &str, begin: &str, end: &str) -> String {
|
|
||||||
let mut wrapped = String::new();
|
|
||||||
let normalized = base64_body.trim().replace(['\r', '\n'], "");
|
|
||||||
|
|
||||||
wrapped.push_str(begin);
|
|
||||||
wrapped.push('\n');
|
|
||||||
for chunk in normalized.as_bytes().chunks(64) {
|
|
||||||
wrapped.push_str(std::str::from_utf8(chunk).unwrap_or_default());
|
|
||||||
wrapped.push('\n');
|
|
||||||
}
|
|
||||||
wrapped.push_str(end);
|
|
||||||
wrapped.push('\n');
|
|
||||||
wrapped
|
|
||||||
}
|
|
||||||
|
|
||||||
fn enrollment_http_client() -> Result<Client, String> {
|
fn enrollment_http_client() -> Result<Client, String> {
|
||||||
Client::builder()
|
Client::builder()
|
||||||
.danger_accept_invalid_certs(true)
|
.danger_accept_invalid_certs(true)
|
||||||
@@ -64,16 +40,18 @@ fn response_error_details(response: reqwest::blocking::Response) -> String {
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
fn fetch_enrollment_config(host: &str, enroll_port: &str) -> Result<EnrollmentConfig, String> {
|
fn fetch_enrollment_config(
|
||||||
let url = format!(
|
host: &str,
|
||||||
"https://{}:{}/Marti/api/tls/config",
|
enroll_port: &str,
|
||||||
host.trim(),
|
username: &str,
|
||||||
enroll_port.trim()
|
password: &str,
|
||||||
);
|
) -> Result<EnrollmentConfig, String> {
|
||||||
|
let url = enrollment_config_url(host, enroll_port);
|
||||||
info!("Fetching TAK enrollment config from {}", url);
|
info!("Fetching TAK enrollment config from {}", url);
|
||||||
|
|
||||||
let response = enrollment_http_client()?
|
let response = enrollment_http_client()?
|
||||||
.get(&url)
|
.get(&url)
|
||||||
|
.basic_auth(username.trim(), Some(password.to_string()))
|
||||||
.send()
|
.send()
|
||||||
.map_err(|e| format!("failed to fetch {}: {}", url, e))?;
|
.map_err(|e| format!("failed to fetch {}: {}", url, e))?;
|
||||||
|
|
||||||
@@ -88,21 +66,14 @@ fn fetch_enrollment_config(host: &str, enroll_port: &str) -> Result<EnrollmentCo
|
|||||||
let response_text = response
|
let response_text = response
|
||||||
.text()
|
.text()
|
||||||
.map_err(|e| format!("failed to read config response from {}: {}", url, e))?;
|
.map_err(|e| format!("failed to read config response from {}: {}", url, e))?;
|
||||||
|
let config = parse_enrollment_config(&response_text);
|
||||||
let server_port = extract_tag_value(&response_text, "serverPort")
|
|
||||||
.ok_or_else(|| "missing serverPort in /Marti/api/tls/config response".to_string())?;
|
|
||||||
let enroll_path = extract_tag_value(&response_text, "enrollPath")
|
|
||||||
.ok_or_else(|| "missing enrollPath in /Marti/api/tls/config response".to_string())?;
|
|
||||||
|
|
||||||
info!(
|
info!(
|
||||||
"Enrollment config received: server_port={} enroll_path={}",
|
"Enrollment config received: server_port={} enroll_path={}",
|
||||||
server_port, enroll_path
|
config.server_port, config.enroll_path
|
||||||
);
|
);
|
||||||
|
|
||||||
Ok(EnrollmentConfig {
|
Ok(config)
|
||||||
server_port,
|
|
||||||
enroll_path,
|
|
||||||
})
|
|
||||||
}
|
}
|
||||||
|
|
||||||
fn enroll_client_certificate(
|
fn enroll_client_certificate(
|
||||||
@@ -134,13 +105,7 @@ fn enroll_client_certificate(
|
|||||||
.map_err(|e| format!("failed to generate CSR: {}", e))?;
|
.map_err(|e| format!("failed to generate CSR: {}", e))?;
|
||||||
let csr_der = csr.der().as_ref().to_vec();
|
let csr_der = csr.der().as_ref().to_vec();
|
||||||
|
|
||||||
let url = format!(
|
let url = enrollment_sign_url(host, enroll_port, enroll_path, client_uid);
|
||||||
"https://{}:{}{}?clientUid={}",
|
|
||||||
host.trim(),
|
|
||||||
enroll_port.trim(),
|
|
||||||
enroll_path.trim(),
|
|
||||||
client_uid.trim()
|
|
||||||
);
|
|
||||||
info!(
|
info!(
|
||||||
"Submitting client certificate enrollment request for {} to {}",
|
"Submitting client certificate enrollment request for {} to {}",
|
||||||
client_uid, url
|
client_uid, url
|
||||||
@@ -173,14 +138,11 @@ fn enroll_client_certificate(
|
|||||||
enrollment.ca0.len()
|
enrollment.ca0.len()
|
||||||
);
|
);
|
||||||
|
|
||||||
let cert_pem = wrap_pem_body(
|
let ca_cert_pem = normalize_certificate_pem(&enrollment.ca0);
|
||||||
&enrollment.signed_cert,
|
let cert_pem = normalize_certificate_pem(&enrollment.signed_cert);
|
||||||
"-----BEGIN CERTIFICATE-----",
|
|
||||||
"-----END CERTIFICATE-----",
|
|
||||||
);
|
|
||||||
let key_pem = key_pair.serialize_pem();
|
let key_pem = key_pair.serialize_pem();
|
||||||
|
|
||||||
Ok((enrollment.ca0, cert_pem, key_pem))
|
Ok((ca_cert_pem, cert_pem, key_pem))
|
||||||
}
|
}
|
||||||
|
|
||||||
pub fn enroll_and_connect(
|
pub fn enroll_and_connect(
|
||||||
@@ -198,13 +160,10 @@ pub fn enroll_and_connect(
|
|||||||
};
|
};
|
||||||
info!(
|
info!(
|
||||||
"Starting enroll_and_connect for host={} enroll_port={} server_name={} client_uid={}",
|
"Starting enroll_and_connect for host={} enroll_port={} server_name={} client_uid={}",
|
||||||
host,
|
host, enroll_port, server_name, normalized_client_uid
|
||||||
enroll_port,
|
|
||||||
server_name,
|
|
||||||
normalized_client_uid
|
|
||||||
);
|
);
|
||||||
|
|
||||||
let enrollment_config = fetch_enrollment_config(host, enroll_port)?;
|
let enrollment_config = fetch_enrollment_config(host, enroll_port, username, password)?;
|
||||||
let (ca_cert_pem, client_cert_pem, client_key_pem) = enroll_client_certificate(
|
let (ca_cert_pem, client_cert_pem, client_key_pem) = enroll_client_certificate(
|
||||||
host,
|
host,
|
||||||
enroll_port,
|
enroll_port,
|
||||||
|
|||||||
@@ -1,5 +1,6 @@
|
|||||||
mod connector;
|
mod connector;
|
||||||
mod enrollment;
|
mod enrollment;
|
||||||
|
mod protocol;
|
||||||
|
|
||||||
pub use connector::connect_mtls;
|
pub use connector::connect_mtls;
|
||||||
pub use enrollment::enroll_and_connect;
|
pub use enrollment::enroll_and_connect;
|
||||||
|
|||||||
@@ -0,0 +1,201 @@
|
|||||||
|
pub(crate) const DEFAULT_MTLS_SERVER_PORT: &str = "8089";
|
||||||
|
pub(crate) const DEFAULT_ENROLL_PATH: &str = "/Marti/api/tls/signClient/v2";
|
||||||
|
|
||||||
|
#[derive(Debug, Clone, PartialEq, Eq)]
|
||||||
|
pub(crate) struct EnrollmentConfig {
|
||||||
|
pub server_port: String,
|
||||||
|
pub enroll_path: String,
|
||||||
|
}
|
||||||
|
|
||||||
|
pub(crate) fn enrollment_config_url(host: &str, enroll_port: &str) -> String {
|
||||||
|
format!(
|
||||||
|
"https://{}:{}/Marti/api/tls/config",
|
||||||
|
host.trim(),
|
||||||
|
enroll_port.trim()
|
||||||
|
)
|
||||||
|
}
|
||||||
|
|
||||||
|
pub(crate) fn enrollment_sign_url(
|
||||||
|
host: &str,
|
||||||
|
enroll_port: &str,
|
||||||
|
enroll_path: &str,
|
||||||
|
client_uid: &str,
|
||||||
|
) -> String {
|
||||||
|
let path = normalize_enroll_path(enroll_path);
|
||||||
|
format!(
|
||||||
|
"https://{}:{}{}?clientUid={}",
|
||||||
|
host.trim(),
|
||||||
|
enroll_port.trim(),
|
||||||
|
path,
|
||||||
|
client_uid.trim()
|
||||||
|
)
|
||||||
|
}
|
||||||
|
|
||||||
|
pub(crate) fn parse_enrollment_config(xml: &str) -> EnrollmentConfig {
|
||||||
|
EnrollmentConfig {
|
||||||
|
server_port: extract_tag_value(xml, "serverPort")
|
||||||
|
.unwrap_or_else(|| DEFAULT_MTLS_SERVER_PORT.to_string()),
|
||||||
|
enroll_path: extract_tag_value(xml, "enrollPath")
|
||||||
|
.map(|path| normalize_enroll_path(&path))
|
||||||
|
.unwrap_or_else(|| DEFAULT_ENROLL_PATH.to_string()),
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
pub(crate) fn normalize_certificate_pem(certificate: &str) -> String {
|
||||||
|
let trimmed = certificate.trim();
|
||||||
|
if trimmed.contains("-----BEGIN CERTIFICATE-----") {
|
||||||
|
format!("{}\n", trimmed)
|
||||||
|
} else {
|
||||||
|
wrap_pem_body(
|
||||||
|
trimmed,
|
||||||
|
"-----BEGIN CERTIFICATE-----",
|
||||||
|
"-----END CERTIFICATE-----",
|
||||||
|
)
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
fn normalize_enroll_path(path: &str) -> String {
|
||||||
|
let trimmed = path.trim();
|
||||||
|
if trimmed.starts_with('/') {
|
||||||
|
trimmed.to_string()
|
||||||
|
} else {
|
||||||
|
format!("/{}", trimmed)
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
fn extract_tag_value(xml: &str, tag_name: &str) -> Option<String> {
|
||||||
|
let open_tag = format!("<{}>", tag_name);
|
||||||
|
let close_tag = format!("</{}>", tag_name);
|
||||||
|
let start = xml.find(&open_tag)? + open_tag.len();
|
||||||
|
let end = xml[start..].find(&close_tag)? + start;
|
||||||
|
Some(xml[start..end].trim().to_string())
|
||||||
|
}
|
||||||
|
|
||||||
|
fn wrap_pem_body(base64_body: &str, begin: &str, end: &str) -> String {
|
||||||
|
let mut wrapped = String::new();
|
||||||
|
let normalized = base64_body.trim().replace(['\r', '\n'], "");
|
||||||
|
|
||||||
|
wrapped.push_str(begin);
|
||||||
|
wrapped.push('\n');
|
||||||
|
for chunk in normalized.as_bytes().chunks(64) {
|
||||||
|
wrapped.push_str(std::str::from_utf8(chunk).unwrap_or_default());
|
||||||
|
wrapped.push('\n');
|
||||||
|
}
|
||||||
|
wrapped.push_str(end);
|
||||||
|
wrapped.push('\n');
|
||||||
|
wrapped
|
||||||
|
}
|
||||||
|
|
||||||
|
#[cfg(test)]
|
||||||
|
mod tests {
|
||||||
|
use super::*;
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn uses_official_tak_defaults() {
|
||||||
|
assert_eq!(DEFAULT_MTLS_SERVER_PORT, "8089");
|
||||||
|
assert_eq!(DEFAULT_ENROLL_PATH, "/Marti/api/tls/signClient/v2");
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn builds_enrollment_config_url_from_trimmed_values() {
|
||||||
|
assert_eq!(
|
||||||
|
enrollment_config_url(" tak.example.test ", " 8446 "),
|
||||||
|
"https://tak.example.test:8446/Marti/api/tls/config"
|
||||||
|
);
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn builds_enrollment_sign_url_and_normalizes_path() {
|
||||||
|
assert_eq!(
|
||||||
|
enrollment_sign_url(
|
||||||
|
" tak.example.test ",
|
||||||
|
" 8446 ",
|
||||||
|
" Marti/api/tls/signClient/v2 ",
|
||||||
|
" client-1 "
|
||||||
|
),
|
||||||
|
"https://tak.example.test:8446/Marti/api/tls/signClient/v2?clientUid=client-1"
|
||||||
|
);
|
||||||
|
|
||||||
|
assert_eq!(
|
||||||
|
enrollment_sign_url(
|
||||||
|
"tak.example.test",
|
||||||
|
"8446",
|
||||||
|
"/custom/enroll",
|
||||||
|
"client-2"
|
||||||
|
),
|
||||||
|
"https://tak.example.test:8446/custom/enroll?clientUid=client-2"
|
||||||
|
);
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn parses_explicit_tak_enrollment_config() {
|
||||||
|
let xml = "<certificateConfig><serverPort>9443</serverPort><enrollPath>Marti/api/tls/signClient/v2</enrollPath></certificateConfig>";
|
||||||
|
|
||||||
|
assert_eq!(
|
||||||
|
parse_enrollment_config(xml),
|
||||||
|
EnrollmentConfig {
|
||||||
|
server_port: "9443".to_string(),
|
||||||
|
enroll_path: "/Marti/api/tls/signClient/v2".to_string(),
|
||||||
|
}
|
||||||
|
);
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn falls_back_when_optional_config_values_are_missing() {
|
||||||
|
let xml = "<certificateConfig><nameEntries /></certificateConfig>";
|
||||||
|
|
||||||
|
assert_eq!(
|
||||||
|
parse_enrollment_config(xml),
|
||||||
|
EnrollmentConfig {
|
||||||
|
server_port: DEFAULT_MTLS_SERVER_PORT.to_string(),
|
||||||
|
enroll_path: DEFAULT_ENROLL_PATH.to_string(),
|
||||||
|
}
|
||||||
|
);
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn returns_none_when_config_closing_tag_is_missing() {
|
||||||
|
assert_eq!(extract_tag_value("<serverPort>9443", "serverPort"), None);
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn trims_extracted_config_values() {
|
||||||
|
let xml = "<certificateConfig><serverPort> 8089 </serverPort><enrollPath> /Marti/api/tls/signClient/v2 </enrollPath></certificateConfig>";
|
||||||
|
|
||||||
|
assert_eq!(
|
||||||
|
parse_enrollment_config(xml),
|
||||||
|
EnrollmentConfig {
|
||||||
|
server_port: "8089".to_string(),
|
||||||
|
enroll_path: DEFAULT_ENROLL_PATH.to_string(),
|
||||||
|
}
|
||||||
|
);
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn normalizes_raw_certificate_body_to_pem() {
|
||||||
|
let raw = format!("{}\r\n{}", "A".repeat(64), "B".repeat(8));
|
||||||
|
let pem = normalize_certificate_pem(&raw);
|
||||||
|
|
||||||
|
assert_eq!(
|
||||||
|
pem,
|
||||||
|
format!(
|
||||||
|
"-----BEGIN CERTIFICATE-----\n{}\n{}\n-----END CERTIFICATE-----\n",
|
||||||
|
"A".repeat(64),
|
||||||
|
"B".repeat(8)
|
||||||
|
)
|
||||||
|
);
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn preserves_existing_pem_and_adds_a_single_trailing_newline() {
|
||||||
|
let with_newline =
|
||||||
|
"-----BEGIN CERTIFICATE-----\nQUJD\n-----END CERTIFICATE-----\n";
|
||||||
|
let without_newline = "-----BEGIN CERTIFICATE-----\nQUJD\n-----END CERTIFICATE-----";
|
||||||
|
|
||||||
|
assert_eq!(normalize_certificate_pem(with_newline), with_newline);
|
||||||
|
assert_eq!(
|
||||||
|
normalize_certificate_pem(without_newline),
|
||||||
|
format!("{}\n", without_newline)
|
||||||
|
);
|
||||||
|
}
|
||||||
|
}
|
||||||
@@ -35,7 +35,12 @@ fn connect_plain(address: &str) -> Result<TransportStream, String> {
|
|||||||
.to_socket_addrs()
|
.to_socket_addrs()
|
||||||
.map_err(|e| format!("failed to resolve {}: {}", address, e))?
|
.map_err(|e| format!("failed to resolve {}: {}", address, e))?
|
||||||
.next()
|
.next()
|
||||||
.ok_or_else(|| format!("failed to resolve {}: no socket addresses returned", address))?;
|
.ok_or_else(|| {
|
||||||
|
format!(
|
||||||
|
"failed to resolve {}: no socket addresses returned",
|
||||||
|
address
|
||||||
|
)
|
||||||
|
})?;
|
||||||
|
|
||||||
info!(
|
info!(
|
||||||
"Opening plain TCP connection to {} (resolved={}) with timeout {:?}",
|
"Opening plain TCP connection to {} (resolved={}) with timeout {:?}",
|
||||||
|
|||||||
+6
-14
@@ -1,25 +1,17 @@
|
|||||||
#[cfg(test)]
|
#[cfg(test)]
|
||||||
mod tests {
|
mod tests {
|
||||||
use crate::init;
|
use crate::init;
|
||||||
use std::vec;
|
|
||||||
use uuid::Uuid;
|
use uuid::Uuid;
|
||||||
|
|
||||||
#[test]
|
#[test]
|
||||||
fn uuid_output_is_uuid4_identifier() {
|
fn uuid_command_accepts_no_arguments_and_rejects_arguments() {
|
||||||
let extension = init().testing();
|
let extension = init().testing();
|
||||||
|
|
||||||
let (output, _) = extension.call("uuid", None);
|
let (output, _) = extension.call("uuid", None);
|
||||||
|
assert!(Uuid::parse_str(&output).is_ok());
|
||||||
|
|
||||||
let validation = Uuid::parse_str(&output);
|
let args = vec!["1".to_string(), "2".to_string()];
|
||||||
|
let (output_with_args, _) = extension.call("uuid", Some(args));
|
||||||
assert!(validation.is_ok())
|
assert_eq!(output_with_args, "");
|
||||||
}
|
|
||||||
|
|
||||||
#[test]
|
|
||||||
fn uuid_output_throws_if_passed_args() {
|
|
||||||
let extension = init().testing();
|
|
||||||
let args: Vec<String> = vec![1.to_string(), 2.to_string()];
|
|
||||||
let (output, _) = extension.call("uuid", Some(args));
|
|
||||||
|
|
||||||
assert_eq!(output, "")
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|||||||
File diff suppressed because it is too large
Load Diff
@@ -0,0 +1,43 @@
|
|||||||
|
pub const AUTOPILOT_COMPONENT_ID: u8 = 1;
|
||||||
|
pub const CAMERA_COMPONENT_ID: u8 = 100;
|
||||||
|
pub const TURRET_CAMERA_COMPONENT_ID: u8 = 101;
|
||||||
|
pub const GIMBAL_COMPONENT_ID: u8 = 154;
|
||||||
|
|
||||||
|
pub const MAV_TYPE_FIXED_WING: u8 = 1;
|
||||||
|
pub const MAV_TYPE_QUADROTOR: u8 = 2;
|
||||||
|
pub const MAV_TYPE_HELICOPTER: u8 = 4;
|
||||||
|
pub const MAV_TYPE_GIMBAL: u8 = 26;
|
||||||
|
pub const MAV_TYPE_CAMERA: u8 = 30;
|
||||||
|
|
||||||
|
pub const MAV_AUTOPILOT_ARDUPILOTMEGA: u8 = 3;
|
||||||
|
pub const MAV_AUTOPILOT_INVALID: u8 = 8;
|
||||||
|
|
||||||
|
pub const MAV_STATE_STANDBY: u8 = 3;
|
||||||
|
pub const MAV_STATE_ACTIVE: u8 = 4;
|
||||||
|
|
||||||
|
pub const MAV_MODE_FLAG_CUSTOM_MODE_ENABLED: u8 = 1;
|
||||||
|
pub const MAV_MODE_FLAG_SAFETY_ARMED: u8 = 128;
|
||||||
|
pub const MAV_LANDED_STATE_UNDEFINED: u8 = 0;
|
||||||
|
pub const MAV_LANDED_STATE_ON_GROUND: u8 = 1;
|
||||||
|
pub const MAV_LANDED_STATE_IN_AIR: u8 = 2;
|
||||||
|
|
||||||
|
pub const MAV_PROTOCOL_CAPABILITY_MISSION_INT: u64 = 4;
|
||||||
|
pub const MAV_PROTOCOL_CAPABILITY_COMMAND_INT: u64 = 8;
|
||||||
|
pub const MAV_PROTOCOL_CAPABILITY_FTP: u64 = 32;
|
||||||
|
pub const MAV_PROTOCOL_CAPABILITY_SET_POSITION_TARGET_GLOBAL_INT: u64 = 256;
|
||||||
|
pub const MAV_PROTOCOL_CAPABILITY_MAVLINK2: u64 = 8192;
|
||||||
|
pub const MAV_PROTOCOL_CAPABILITY_COMPONENT_IMPLEMENTS_GIMBAL_MANAGER: u64 = 262_144;
|
||||||
|
|
||||||
|
pub const CAMERA_CAP_FLAGS_CAPTURE_VIDEO: u32 = 1;
|
||||||
|
pub const CAMERA_CAP_FLAGS_CAPTURE_IMAGE: u32 = 2;
|
||||||
|
pub const CAMERA_CAP_FLAGS_HAS_MODES: u32 = 4;
|
||||||
|
pub const CAMERA_CAP_FLAGS_HAS_BASIC_ZOOM: u32 = 64;
|
||||||
|
pub const CAMERA_CAP_FLAGS_HAS_VIDEO_STREAM: u32 = 256;
|
||||||
|
pub const VIDEO_STREAM_STATUS_FLAGS_RUNNING: u16 = 1;
|
||||||
|
pub const VIDEO_STREAM_TYPE_RTSP: u8 = 0;
|
||||||
|
pub const VIDEO_STREAM_TYPE_RTPUDP: u8 = 1;
|
||||||
|
pub const VIDEO_STREAM_TYPE_TCP_MPEG: u8 = 2;
|
||||||
|
pub const VIDEO_STREAM_TYPE_MPEG_TS: u8 = 3;
|
||||||
|
pub const VIDEO_STREAM_ENCODING_H264: u8 = 1;
|
||||||
|
|
||||||
|
pub const GIMBAL_MANAGER_CAP_FLAGS_BASIC_PITCH_YAW: u32 = 32 | 128 | 256 | 1024 | 4096 | 131_072;
|
||||||
+169
@@ -0,0 +1,169 @@
|
|||||||
|
use std::sync::atomic::{AtomicU8, Ordering};
|
||||||
|
|
||||||
|
static MAVLINK_SEQUENCE: AtomicU8 = AtomicU8::new(0);
|
||||||
|
|
||||||
|
#[derive(Clone, Copy)]
|
||||||
|
pub(crate) struct FieldSpec {
|
||||||
|
pub ty: &'static str,
|
||||||
|
pub name: &'static str,
|
||||||
|
pub array_len: usize,
|
||||||
|
}
|
||||||
|
|
||||||
|
fn crc_accumulate(byte: u8, crc: &mut u16) {
|
||||||
|
let mut tmp = byte ^ (*crc as u8);
|
||||||
|
tmp ^= tmp << 4;
|
||||||
|
*crc = (*crc >> 8) ^ ((tmp as u16) << 8) ^ ((tmp as u16) << 3) ^ ((tmp as u16) >> 4);
|
||||||
|
}
|
||||||
|
|
||||||
|
fn mavlink_crc(bytes: &[u8], crc_extra: u8) -> u16 {
|
||||||
|
let mut crc = 0xFFFFu16;
|
||||||
|
for byte in bytes {
|
||||||
|
crc_accumulate(*byte, &mut crc);
|
||||||
|
}
|
||||||
|
crc_accumulate(crc_extra, &mut crc);
|
||||||
|
crc
|
||||||
|
}
|
||||||
|
|
||||||
|
pub(crate) fn calculate_crc_extra(message_name: &str, base_fields: &[FieldSpec]) -> u8 {
|
||||||
|
let mut crc = 0xFFFFu16;
|
||||||
|
|
||||||
|
for byte in message_name.as_bytes() {
|
||||||
|
crc_accumulate(*byte, &mut crc);
|
||||||
|
}
|
||||||
|
crc_accumulate(b' ', &mut crc);
|
||||||
|
|
||||||
|
for field in base_fields {
|
||||||
|
for byte in field.ty.as_bytes() {
|
||||||
|
crc_accumulate(*byte, &mut crc);
|
||||||
|
}
|
||||||
|
crc_accumulate(b' ', &mut crc);
|
||||||
|
|
||||||
|
for byte in field.name.as_bytes() {
|
||||||
|
crc_accumulate(*byte, &mut crc);
|
||||||
|
}
|
||||||
|
crc_accumulate(b' ', &mut crc);
|
||||||
|
|
||||||
|
if field.array_len > 0 {
|
||||||
|
crc_accumulate(field.array_len as u8, &mut crc);
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
((crc & 0xFF) ^ (crc >> 8)) as u8
|
||||||
|
}
|
||||||
|
|
||||||
|
pub(crate) fn build_v1_packet(
|
||||||
|
system_id: u8,
|
||||||
|
component_id: u8,
|
||||||
|
msg_id: u8,
|
||||||
|
payload: &[u8],
|
||||||
|
crc_extra: u8,
|
||||||
|
) -> Vec<u8> {
|
||||||
|
let seq = MAVLINK_SEQUENCE.fetch_add(1, Ordering::Relaxed);
|
||||||
|
let mut packet = Vec::with_capacity(payload.len() + 8);
|
||||||
|
packet.push(0xFE);
|
||||||
|
packet.push(payload.len() as u8);
|
||||||
|
packet.push(seq);
|
||||||
|
packet.push(system_id);
|
||||||
|
packet.push(component_id);
|
||||||
|
packet.push(msg_id);
|
||||||
|
packet.extend_from_slice(payload);
|
||||||
|
|
||||||
|
let crc = mavlink_crc(&packet[1..], crc_extra);
|
||||||
|
packet.push((crc & 0xFF) as u8);
|
||||||
|
packet.push((crc >> 8) as u8);
|
||||||
|
packet
|
||||||
|
}
|
||||||
|
|
||||||
|
pub(crate) fn build_v2_packet(
|
||||||
|
system_id: u8,
|
||||||
|
component_id: u8,
|
||||||
|
msg_id: u32,
|
||||||
|
payload: &[u8],
|
||||||
|
crc_extra: u8,
|
||||||
|
) -> Vec<u8> {
|
||||||
|
let seq = MAVLINK_SEQUENCE.fetch_add(1, Ordering::Relaxed);
|
||||||
|
let mut packet = Vec::with_capacity(payload.len() + 12);
|
||||||
|
packet.push(0xFD);
|
||||||
|
packet.push(payload.len() as u8);
|
||||||
|
packet.push(0);
|
||||||
|
packet.push(0);
|
||||||
|
packet.push(seq);
|
||||||
|
packet.push(system_id);
|
||||||
|
packet.push(component_id);
|
||||||
|
packet.push((msg_id & 0xFF) as u8);
|
||||||
|
packet.push(((msg_id >> 8) & 0xFF) as u8);
|
||||||
|
packet.push(((msg_id >> 16) & 0xFF) as u8);
|
||||||
|
packet.extend_from_slice(payload);
|
||||||
|
|
||||||
|
let crc = mavlink_crc(&packet[1..], crc_extra);
|
||||||
|
packet.push((crc & 0xFF) as u8);
|
||||||
|
packet.push((crc >> 8) as u8);
|
||||||
|
packet
|
||||||
|
}
|
||||||
|
|
||||||
|
#[cfg(test)]
|
||||||
|
mod tests {
|
||||||
|
use super::{build_v1_packet, build_v2_packet, calculate_crc_extra, mavlink_crc, FieldSpec};
|
||||||
|
|
||||||
|
fn assert_packet_crc(packet: &[u8], crc_extra: u8) {
|
||||||
|
let checksum_offset = packet.len() - 2;
|
||||||
|
let expected = mavlink_crc(&packet[1..checksum_offset], crc_extra);
|
||||||
|
let actual = u16::from_le_bytes([packet[checksum_offset], packet[checksum_offset + 1]]);
|
||||||
|
assert_eq!(actual, expected);
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn crc_extra_is_deterministic_for_scalar_and_array_fields() {
|
||||||
|
let fields = [
|
||||||
|
FieldSpec {
|
||||||
|
ty: "uint32_t",
|
||||||
|
name: "time_boot_ms",
|
||||||
|
array_len: 0,
|
||||||
|
},
|
||||||
|
FieldSpec {
|
||||||
|
ty: "char",
|
||||||
|
name: "name",
|
||||||
|
array_len: 16,
|
||||||
|
},
|
||||||
|
];
|
||||||
|
|
||||||
|
let first = calculate_crc_extra("ARMATAK_TEST", &fields);
|
||||||
|
let second = calculate_crc_extra("ARMATAK_TEST", &fields);
|
||||||
|
let no_fields = calculate_crc_extra("ARMATAK_TEST", &[]);
|
||||||
|
|
||||||
|
assert_eq!(first, second);
|
||||||
|
assert_ne!(first, no_fields);
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn builds_valid_mavlink_v1_packet() {
|
||||||
|
let payload = [0x10, 0x20, 0x30];
|
||||||
|
let packet = build_v1_packet(7, 9, 42, &payload, 77);
|
||||||
|
|
||||||
|
assert_eq!(packet[0], 0xFE);
|
||||||
|
assert_eq!(packet[1], payload.len() as u8);
|
||||||
|
assert_eq!(packet[3], 7);
|
||||||
|
assert_eq!(packet[4], 9);
|
||||||
|
assert_eq!(packet[5], 42);
|
||||||
|
assert_eq!(&packet[6..9], &payload);
|
||||||
|
assert_eq!(packet.len(), payload.len() + 8);
|
||||||
|
assert_packet_crc(&packet, 77);
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn builds_valid_mavlink_v2_packet_with_three_byte_message_id() {
|
||||||
|
let payload = [0xAA, 0xBB];
|
||||||
|
let packet = build_v2_packet(11, 13, 0x01_02_03, &payload, 99);
|
||||||
|
|
||||||
|
assert_eq!(packet[0], 0xFD);
|
||||||
|
assert_eq!(packet[1], payload.len() as u8);
|
||||||
|
assert_eq!(packet[2], 0);
|
||||||
|
assert_eq!(packet[3], 0);
|
||||||
|
assert_eq!(packet[5], 11);
|
||||||
|
assert_eq!(packet[6], 13);
|
||||||
|
assert_eq!(&packet[7..10], &[0x03, 0x02, 0x01]);
|
||||||
|
assert_eq!(&packet[10..12], &payload);
|
||||||
|
assert_eq!(packet.len(), payload.len() + 12);
|
||||||
|
assert_packet_crc(&packet, 99);
|
||||||
|
}
|
||||||
|
}
|
||||||
@@ -0,0 +1,160 @@
|
|||||||
|
use arma_rs::Context;
|
||||||
|
use log::info;
|
||||||
|
use std::net::UdpSocket;
|
||||||
|
use std::sync::atomic::{AtomicBool, Ordering};
|
||||||
|
use std::sync::{Arc, Mutex};
|
||||||
|
use std::thread::{self, JoinHandle};
|
||||||
|
use std::time::Duration;
|
||||||
|
|
||||||
|
use super::callbacks::{mavlink_callback_event, mavlink_packet_summary, mavlink_response_packets};
|
||||||
|
|
||||||
|
pub(crate) struct MavlinkEndpoint {
|
||||||
|
pub socket: UdpSocket,
|
||||||
|
pub running: Arc<AtomicBool>,
|
||||||
|
pub listener: Option<JoinHandle<()>>,
|
||||||
|
pub bind_port: u16,
|
||||||
|
}
|
||||||
|
|
||||||
|
static MAVLINK_ENDPOINT: Mutex<Option<MavlinkEndpoint>> = Mutex::new(None);
|
||||||
|
|
||||||
|
pub(crate) fn socket_for_send() -> Option<UdpSocket> {
|
||||||
|
MAVLINK_ENDPOINT.lock().ok().and_then(|endpoint| {
|
||||||
|
endpoint
|
||||||
|
.as_ref()
|
||||||
|
.and_then(|entry| entry.socket.try_clone().ok())
|
||||||
|
})
|
||||||
|
}
|
||||||
|
|
||||||
|
fn stop_endpoint_internal() {
|
||||||
|
let endpoint = MAVLINK_ENDPOINT.lock().unwrap().take();
|
||||||
|
|
||||||
|
if let Some(mut endpoint) = endpoint {
|
||||||
|
endpoint.running.store(false, Ordering::Relaxed);
|
||||||
|
info!(
|
||||||
|
"Stopping MAVLink UDP endpoint on 0.0.0.0:{}",
|
||||||
|
endpoint.bind_port
|
||||||
|
);
|
||||||
|
|
||||||
|
if let Some(listener) = endpoint.listener.take() {
|
||||||
|
let _ = listener.join();
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
pub fn start_endpoint(ctx: Context, bind_port: i32) -> &'static str {
|
||||||
|
let bind_port = bind_port.clamp(1, 65535) as u16;
|
||||||
|
|
||||||
|
stop_endpoint_internal();
|
||||||
|
|
||||||
|
let socket = match UdpSocket::bind(format!("0.0.0.0:{bind_port}")) {
|
||||||
|
Ok(socket) => socket,
|
||||||
|
Err(error) => {
|
||||||
|
let _ = ctx.callback_data(
|
||||||
|
"MAVLINK UDP ERROR",
|
||||||
|
"failed to bind MAVLink UDP endpoint",
|
||||||
|
error.to_string(),
|
||||||
|
);
|
||||||
|
info!(
|
||||||
|
"Failed to bind MAVLink UDP endpoint on 0.0.0.0:{}: {}",
|
||||||
|
bind_port, error
|
||||||
|
);
|
||||||
|
return "Failed to bind MAVLink UDP endpoint";
|
||||||
|
}
|
||||||
|
};
|
||||||
|
|
||||||
|
if let Err(error) = socket.set_read_timeout(Some(Duration::from_millis(500))) {
|
||||||
|
info!(
|
||||||
|
"Failed to set MAVLink UDP endpoint read timeout on 0.0.0.0:{}: {}",
|
||||||
|
bind_port, error
|
||||||
|
);
|
||||||
|
}
|
||||||
|
|
||||||
|
let listener_socket = match socket.try_clone() {
|
||||||
|
Ok(listener_socket) => listener_socket,
|
||||||
|
Err(error) => {
|
||||||
|
let _ = ctx.callback_data(
|
||||||
|
"MAVLINK UDP ERROR",
|
||||||
|
"failed to clone MAVLink UDP endpoint socket",
|
||||||
|
error.to_string(),
|
||||||
|
);
|
||||||
|
info!(
|
||||||
|
"Failed to clone MAVLink UDP endpoint socket on 0.0.0.0:{}: {}",
|
||||||
|
bind_port, error
|
||||||
|
);
|
||||||
|
return "Failed to clone MAVLink UDP endpoint socket";
|
||||||
|
}
|
||||||
|
};
|
||||||
|
|
||||||
|
let running = Arc::new(AtomicBool::new(true));
|
||||||
|
let listener_running = Arc::clone(&running);
|
||||||
|
|
||||||
|
let listener_ctx = ctx;
|
||||||
|
let listener = thread::spawn(move || {
|
||||||
|
let mut buffer = [0u8; 2048];
|
||||||
|
info!("MAVLink UDP endpoint listening on 0.0.0.0:{}", bind_port);
|
||||||
|
|
||||||
|
while listener_running.load(Ordering::Relaxed) {
|
||||||
|
match listener_socket.recv_from(&mut buffer) {
|
||||||
|
Ok((received, source)) => {
|
||||||
|
let source_string = source.to_string();
|
||||||
|
info!(
|
||||||
|
"MAVLink UDP endpoint received {} bytes from {}: {}",
|
||||||
|
received,
|
||||||
|
source,
|
||||||
|
mavlink_packet_summary(&buffer[..received])
|
||||||
|
);
|
||||||
|
if let Some(event) = mavlink_callback_event(&buffer[..received], &source_string)
|
||||||
|
{
|
||||||
|
let _ =
|
||||||
|
listener_ctx.callback_data("MAVLINK UDP", event.function, event.data);
|
||||||
|
}
|
||||||
|
for packet in mavlink_response_packets(&buffer[..received]) {
|
||||||
|
if let Err(error) = listener_socket.send_to(&packet, source) {
|
||||||
|
info!(
|
||||||
|
"MAVLink UDP endpoint failed sending response to {}: {}",
|
||||||
|
source, error
|
||||||
|
);
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
Err(error)
|
||||||
|
if matches!(
|
||||||
|
error.kind(),
|
||||||
|
std::io::ErrorKind::WouldBlock
|
||||||
|
| std::io::ErrorKind::TimedOut
|
||||||
|
| std::io::ErrorKind::ConnectionReset
|
||||||
|
) => {}
|
||||||
|
Err(error) => {
|
||||||
|
if listener_running.load(Ordering::Relaxed) {
|
||||||
|
info!(
|
||||||
|
"MAVLink UDP endpoint listener error on 0.0.0.0:{}: {}",
|
||||||
|
bind_port, error
|
||||||
|
);
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
info!(
|
||||||
|
"MAVLink UDP endpoint listener stopped on 0.0.0.0:{}",
|
||||||
|
bind_port
|
||||||
|
);
|
||||||
|
});
|
||||||
|
|
||||||
|
*MAVLINK_ENDPOINT.lock().unwrap() = Some(MavlinkEndpoint {
|
||||||
|
socket,
|
||||||
|
running,
|
||||||
|
listener: Some(listener),
|
||||||
|
bind_port,
|
||||||
|
});
|
||||||
|
|
||||||
|
info!("Started MAVLink UDP endpoint on 0.0.0.0:{}", bind_port);
|
||||||
|
"Started MAVLink UDP endpoint"
|
||||||
|
}
|
||||||
|
|
||||||
|
pub fn stop_endpoint(_ctx: Context) -> &'static str {
|
||||||
|
stop_endpoint_internal();
|
||||||
|
"Stopped MAVLink UDP endpoint"
|
||||||
|
}
|
||||||
@@ -0,0 +1,191 @@
|
|||||||
|
use super::constants::{MAV_TYPE_FIXED_WING, MAV_TYPE_HELICOPTER, MAV_TYPE_QUADROTOR};
|
||||||
|
|
||||||
|
pub(crate) fn map_vehicle_type(vehicle_type: u8) -> u8 {
|
||||||
|
match vehicle_type {
|
||||||
|
1 => MAV_TYPE_FIXED_WING,
|
||||||
|
3 => MAV_TYPE_HELICOPTER,
|
||||||
|
2 => MAV_TYPE_QUADROTOR,
|
||||||
|
value => value,
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
pub(crate) fn normalize_heading_deg(value: f32) -> f32 {
|
||||||
|
((value % 360.0) + 360.0) % 360.0
|
||||||
|
}
|
||||||
|
|
||||||
|
pub(crate) fn stable_system_id(entity_uuid: &str) -> u8 {
|
||||||
|
let mut hash: u32 = 0x811C9DC5;
|
||||||
|
for byte in entity_uuid.as_bytes() {
|
||||||
|
hash ^= *byte as u32;
|
||||||
|
hash = hash.wrapping_mul(0x01000193);
|
||||||
|
}
|
||||||
|
|
||||||
|
((hash % 250) as u8) + 1
|
||||||
|
}
|
||||||
|
|
||||||
|
pub(crate) fn stable_mavlink_identity(callsign: &str, entity_uuid: &str) -> String {
|
||||||
|
let mut identity = callsign.trim().to_string();
|
||||||
|
|
||||||
|
for suffix in [" [ON]", " [OFF]"] {
|
||||||
|
if identity.ends_with(suffix) {
|
||||||
|
identity.truncate(identity.len() - suffix.len());
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
if identity.is_empty() {
|
||||||
|
entity_uuid.trim().to_string()
|
||||||
|
} else {
|
||||||
|
identity
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
fn uuid16(entity_uuid: &str) -> [u8; 16] {
|
||||||
|
let hex = entity_uuid.replace('-', "");
|
||||||
|
let mut bytes = [0u8; 16];
|
||||||
|
|
||||||
|
for index in 0..16 {
|
||||||
|
let start = index * 2;
|
||||||
|
if start + 2 <= hex.len() {
|
||||||
|
if let Ok(value) = u8::from_str_radix(&hex[start..start + 2], 16) {
|
||||||
|
bytes[index] = value;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
bytes
|
||||||
|
}
|
||||||
|
|
||||||
|
pub(crate) fn uid64_from_uuid(entity_uuid: &str) -> u64 {
|
||||||
|
let uuid = uuid16(entity_uuid);
|
||||||
|
let mut bytes = [0u8; 8];
|
||||||
|
bytes.copy_from_slice(&uuid[..8]);
|
||||||
|
u64::from_le_bytes(bytes)
|
||||||
|
}
|
||||||
|
|
||||||
|
pub(crate) fn uid2_from_uuid(entity_uuid: &str) -> [u8; 18] {
|
||||||
|
let uuid = uuid16(entity_uuid);
|
||||||
|
let mut uid2 = [0u8; 18];
|
||||||
|
uid2[..16].copy_from_slice(&uuid);
|
||||||
|
|
||||||
|
let checksum = entity_uuid
|
||||||
|
.as_bytes()
|
||||||
|
.iter()
|
||||||
|
.fold(0u16, |acc, value| acc.wrapping_add(*value as u16));
|
||||||
|
uid2[16] = (checksum & 0xFF) as u8;
|
||||||
|
uid2[17] = (checksum >> 8) as u8;
|
||||||
|
uid2
|
||||||
|
}
|
||||||
|
|
||||||
|
pub(crate) fn fixed_string<const N: usize>(value: &str) -> [u8; N] {
|
||||||
|
let mut bytes = [0u8; N];
|
||||||
|
let raw = value.as_bytes();
|
||||||
|
let len = raw.len().min(N.saturating_sub(1));
|
||||||
|
bytes[..len].copy_from_slice(&raw[..len]);
|
||||||
|
bytes
|
||||||
|
}
|
||||||
|
|
||||||
|
pub(crate) fn should_send_video_stream_information(video_uri: &str) -> bool {
|
||||||
|
let trimmed = video_uri.trim().to_ascii_lowercase();
|
||||||
|
trimmed.starts_with("rtsp://")
|
||||||
|
|| trimmed.starts_with("rtp://")
|
||||||
|
|| trimmed.starts_with("udp://")
|
||||||
|
|| trimmed.starts_with("mpegts://")
|
||||||
|
|| trimmed.starts_with("tcp://")
|
||||||
|
}
|
||||||
|
|
||||||
|
#[cfg(test)]
|
||||||
|
mod tests {
|
||||||
|
use super::*;
|
||||||
|
|
||||||
|
const UUID: &str = "00112233-4455-6677-8899-aabbccddeeff";
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn maps_arma_vehicle_types_to_mavlink_types() {
|
||||||
|
assert_eq!(map_vehicle_type(1), MAV_TYPE_FIXED_WING);
|
||||||
|
assert_eq!(map_vehicle_type(2), MAV_TYPE_QUADROTOR);
|
||||||
|
assert_eq!(map_vehicle_type(3), MAV_TYPE_HELICOPTER);
|
||||||
|
assert_eq!(map_vehicle_type(99), 99);
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn normalizes_headings_to_zero_through_360() {
|
||||||
|
assert_eq!(normalize_heading_deg(0.0), 0.0);
|
||||||
|
assert_eq!(normalize_heading_deg(370.0), 10.0);
|
||||||
|
assert_eq!(normalize_heading_deg(-10.0), 350.0);
|
||||||
|
assert_eq!(normalize_heading_deg(720.0), 0.0);
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn stable_system_id_is_deterministic_and_in_mavlink_range() {
|
||||||
|
let first = stable_system_id(UUID);
|
||||||
|
let second = stable_system_id(UUID);
|
||||||
|
|
||||||
|
assert_eq!(first, second);
|
||||||
|
assert!((1..=250).contains(&first));
|
||||||
|
assert!((1..=250).contains(&stable_system_id("")));
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn stable_identity_trims_runtime_status_suffixes_and_falls_back_to_uuid() {
|
||||||
|
assert_eq!(stable_mavlink_identity(" Falcon ", UUID), "Falcon");
|
||||||
|
assert_eq!(stable_mavlink_identity("Falcon [ON]", UUID), "Falcon");
|
||||||
|
assert_eq!(stable_mavlink_identity("Falcon [OFF]", UUID), "Falcon");
|
||||||
|
assert_eq!(stable_mavlink_identity(" ", UUID), UUID);
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn converts_uuid_to_fixed_binary_identifiers() {
|
||||||
|
assert_eq!(
|
||||||
|
uid64_from_uuid(UUID),
|
||||||
|
u64::from_le_bytes([0x00, 0x11, 0x22, 0x33, 0x44, 0x55, 0x66, 0x77])
|
||||||
|
);
|
||||||
|
|
||||||
|
let uid2 = uid2_from_uuid(UUID);
|
||||||
|
assert_eq!(
|
||||||
|
&uid2[..16],
|
||||||
|
&[
|
||||||
|
0x00, 0x11, 0x22, 0x33, 0x44, 0x55, 0x66, 0x77, 0x88, 0x99, 0xaa, 0xbb,
|
||||||
|
0xcc, 0xdd, 0xee, 0xff,
|
||||||
|
]
|
||||||
|
);
|
||||||
|
let checksum = UUID
|
||||||
|
.as_bytes()
|
||||||
|
.iter()
|
||||||
|
.fold(0u16, |acc, value| acc.wrapping_add(*value as u16));
|
||||||
|
assert_eq!(&uid2[16..], &checksum.to_le_bytes());
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn malformed_or_short_uuid_components_are_zero_filled() {
|
||||||
|
let invalid = uuid16("gg");
|
||||||
|
assert_eq!(invalid, [0; 16]);
|
||||||
|
|
||||||
|
let short = uuid16("01");
|
||||||
|
assert_eq!(short[0], 1);
|
||||||
|
assert!(short[1..].iter().all(|byte| *byte == 0));
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn fixed_string_reserves_a_nul_terminator_and_handles_zero_length() {
|
||||||
|
assert_eq!(fixed_string::<5>("abcdef"), [b'a', b'b', b'c', b'd', 0]);
|
||||||
|
assert_eq!(fixed_string::<5>("ab"), [b'a', b'b', 0, 0, 0]);
|
||||||
|
assert_eq!(fixed_string::<0>("ab"), [0u8; 0]);
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn identifies_supported_video_stream_schemes_case_insensitively() {
|
||||||
|
for uri in [
|
||||||
|
" RTSP://host/live ",
|
||||||
|
"rtp://host/live",
|
||||||
|
"udp://239.1.1.1:1234",
|
||||||
|
"mpegts://host/live",
|
||||||
|
"tcp://host:1234",
|
||||||
|
] {
|
||||||
|
assert!(should_send_video_stream_information(uri), "{uri}");
|
||||||
|
}
|
||||||
|
|
||||||
|
assert!(!should_send_video_stream_information("https://host/live"));
|
||||||
|
assert!(!should_send_video_stream_information(""));
|
||||||
|
}
|
||||||
|
}
|
||||||
@@ -0,0 +1,14 @@
|
|||||||
|
mod callbacks;
|
||||||
|
mod constants;
|
||||||
|
mod crc;
|
||||||
|
mod endpoint;
|
||||||
|
mod identity;
|
||||||
|
mod packets;
|
||||||
|
mod payload;
|
||||||
|
mod send;
|
||||||
|
mod state;
|
||||||
|
|
||||||
|
pub use endpoint::{start_endpoint, stop_endpoint};
|
||||||
|
#[allow(unused_imports)]
|
||||||
|
pub use payload::{UasSystemPayload, UasTelemetryPayload};
|
||||||
|
pub use send::{send_uas_system, send_uas_telemetry};
|
||||||
@@ -0,0 +1,644 @@
|
|||||||
|
use chrono::Utc;
|
||||||
|
|
||||||
|
use super::constants::{
|
||||||
|
AUTOPILOT_COMPONENT_ID, CAMERA_CAP_FLAGS_CAPTURE_IMAGE, CAMERA_CAP_FLAGS_CAPTURE_VIDEO,
|
||||||
|
CAMERA_CAP_FLAGS_HAS_BASIC_ZOOM, CAMERA_CAP_FLAGS_HAS_MODES, CAMERA_CAP_FLAGS_HAS_VIDEO_STREAM,
|
||||||
|
GIMBAL_COMPONENT_ID, GIMBAL_MANAGER_CAP_FLAGS_BASIC_PITCH_YAW, MAV_AUTOPILOT_ARDUPILOTMEGA,
|
||||||
|
MAV_AUTOPILOT_INVALID, MAV_LANDED_STATE_IN_AIR, MAV_LANDED_STATE_ON_GROUND,
|
||||||
|
MAV_LANDED_STATE_UNDEFINED, MAV_MODE_FLAG_CUSTOM_MODE_ENABLED, MAV_MODE_FLAG_SAFETY_ARMED,
|
||||||
|
MAV_PROTOCOL_CAPABILITY_COMMAND_INT,
|
||||||
|
MAV_PROTOCOL_CAPABILITY_COMPONENT_IMPLEMENTS_GIMBAL_MANAGER, MAV_PROTOCOL_CAPABILITY_FTP,
|
||||||
|
MAV_PROTOCOL_CAPABILITY_MAVLINK2, MAV_PROTOCOL_CAPABILITY_MISSION_INT,
|
||||||
|
MAV_PROTOCOL_CAPABILITY_SET_POSITION_TARGET_GLOBAL_INT, MAV_STATE_ACTIVE, MAV_STATE_STANDBY,
|
||||||
|
VIDEO_STREAM_ENCODING_H264, VIDEO_STREAM_STATUS_FLAGS_RUNNING, VIDEO_STREAM_TYPE_MPEG_TS,
|
||||||
|
VIDEO_STREAM_TYPE_RTPUDP, VIDEO_STREAM_TYPE_RTSP, VIDEO_STREAM_TYPE_TCP_MPEG,
|
||||||
|
};
|
||||||
|
use super::crc::{build_v1_packet, build_v2_packet, calculate_crc_extra, FieldSpec};
|
||||||
|
use super::identity::{fixed_string, normalize_heading_deg, uid2_from_uuid, uid64_from_uuid};
|
||||||
|
use super::payload::UasTelemetryPayload;
|
||||||
|
|
||||||
|
pub(crate) fn heartbeat_packet(payload: &UasTelemetryPayload) -> Vec<u8> {
|
||||||
|
let mut msg = Vec::with_capacity(9);
|
||||||
|
let custom_mode = if payload.flying { 5u32 } else { 0u32 };
|
||||||
|
msg.extend_from_slice(&custom_mode.to_le_bytes());
|
||||||
|
msg.push(payload.vehicle_type);
|
||||||
|
msg.push(MAV_AUTOPILOT_ARDUPILOTMEGA);
|
||||||
|
msg.push(if payload.flying {
|
||||||
|
MAV_MODE_FLAG_CUSTOM_MODE_ENABLED | MAV_MODE_FLAG_SAFETY_ARMED
|
||||||
|
} else {
|
||||||
|
MAV_MODE_FLAG_CUSTOM_MODE_ENABLED
|
||||||
|
});
|
||||||
|
msg.push(if payload.flying {
|
||||||
|
MAV_STATE_ACTIVE
|
||||||
|
} else {
|
||||||
|
MAV_STATE_STANDBY
|
||||||
|
});
|
||||||
|
msg.push(3);
|
||||||
|
build_v1_packet(payload.system_id, payload.component_id, 0, &msg, 50)
|
||||||
|
}
|
||||||
|
|
||||||
|
pub(crate) fn command_ack_packet(
|
||||||
|
system_id: u8,
|
||||||
|
component_id: u8,
|
||||||
|
command: u16,
|
||||||
|
result: u8,
|
||||||
|
) -> Vec<u8> {
|
||||||
|
let mut msg = Vec::with_capacity(3);
|
||||||
|
msg.extend_from_slice(&command.to_le_bytes());
|
||||||
|
msg.push(result);
|
||||||
|
build_v2_packet(system_id, component_id, 77, &msg, 143)
|
||||||
|
}
|
||||||
|
|
||||||
|
pub(crate) fn mission_request_int_packet(
|
||||||
|
system_id: u8,
|
||||||
|
component_id: u8,
|
||||||
|
target_system: u8,
|
||||||
|
target_component: u8,
|
||||||
|
seq: u16,
|
||||||
|
mission_type: u8,
|
||||||
|
) -> Vec<u8> {
|
||||||
|
let mut msg = Vec::with_capacity(5);
|
||||||
|
msg.extend_from_slice(&seq.to_le_bytes());
|
||||||
|
msg.push(target_system);
|
||||||
|
msg.push(target_component);
|
||||||
|
msg.push(mission_type);
|
||||||
|
build_v2_packet(system_id, component_id, 51, &msg, 196)
|
||||||
|
}
|
||||||
|
|
||||||
|
pub(crate) fn mission_ack_packet(
|
||||||
|
system_id: u8,
|
||||||
|
component_id: u8,
|
||||||
|
target_system: u8,
|
||||||
|
target_component: u8,
|
||||||
|
mission_type: u8,
|
||||||
|
) -> Vec<u8> {
|
||||||
|
let mut msg = Vec::with_capacity(4);
|
||||||
|
msg.push(target_system);
|
||||||
|
msg.push(target_component);
|
||||||
|
msg.push(0);
|
||||||
|
msg.push(mission_type);
|
||||||
|
build_v2_packet(system_id, component_id, 47, &msg, 153)
|
||||||
|
}
|
||||||
|
|
||||||
|
pub(crate) fn gps_raw_int_packet(payload: &UasTelemetryPayload) -> Vec<u8> {
|
||||||
|
let time_usec = (Utc::now().timestamp_millis().max(0) as u64) * 1_000;
|
||||||
|
let fix_type = if payload.flying { 3u8 } else { 2u8 };
|
||||||
|
|
||||||
|
let mut msg = Vec::with_capacity(30);
|
||||||
|
msg.extend_from_slice(&time_usec.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&((payload.lat_deg * 1e7).round() as i32).to_le_bytes());
|
||||||
|
msg.extend_from_slice(&((payload.lon_deg * 1e7).round() as i32).to_le_bytes());
|
||||||
|
msg.extend_from_slice(&((payload.alt_msl_m * 1000.0).round() as i32).to_le_bytes());
|
||||||
|
msg.extend_from_slice(&u16::MAX.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&u16::MAX.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&u16::MAX.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&u16::MAX.to_le_bytes());
|
||||||
|
msg.push(fix_type);
|
||||||
|
msg.push(10);
|
||||||
|
build_v1_packet(payload.system_id, payload.component_id, 24, &msg, 24)
|
||||||
|
}
|
||||||
|
|
||||||
|
pub(crate) fn global_position_int_packet(payload: &UasTelemetryPayload) -> Vec<u8> {
|
||||||
|
let time_boot_ms = Utc::now().timestamp_millis().max(0) as u32;
|
||||||
|
let vx =
|
||||||
|
(payload.groundspeed_mps * payload.heading_deg.to_radians().sin() * 100.0).round() as i16;
|
||||||
|
let vy =
|
||||||
|
(payload.groundspeed_mps * payload.heading_deg.to_radians().cos() * 100.0).round() as i16;
|
||||||
|
let heading = (normalize_heading_deg(payload.heading_deg) * 100.0).round() as u16;
|
||||||
|
|
||||||
|
let mut msg = Vec::with_capacity(28);
|
||||||
|
msg.extend_from_slice(&time_boot_ms.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&((payload.lat_deg * 1e7).round() as i32).to_le_bytes());
|
||||||
|
msg.extend_from_slice(&((payload.lon_deg * 1e7).round() as i32).to_le_bytes());
|
||||||
|
msg.extend_from_slice(&((payload.alt_msl_m * 1000.0).round() as i32).to_le_bytes());
|
||||||
|
msg.extend_from_slice(&((payload.rel_alt_m * 1000.0).round() as i32).to_le_bytes());
|
||||||
|
msg.extend_from_slice(&vx.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&vy.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&0i16.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&heading.to_le_bytes());
|
||||||
|
build_v1_packet(payload.system_id, payload.component_id, 33, &msg, 104)
|
||||||
|
}
|
||||||
|
|
||||||
|
pub(crate) fn attitude_packet(payload: &UasTelemetryPayload) -> Vec<u8> {
|
||||||
|
let now_ms = Utc::now().timestamp_millis().max(0) as u32;
|
||||||
|
let roll = payload.roll_deg.to_radians();
|
||||||
|
let pitch = payload.pitch_deg.to_radians();
|
||||||
|
let yaw = payload.yaw_deg.to_radians();
|
||||||
|
|
||||||
|
let mut msg = Vec::with_capacity(28);
|
||||||
|
msg.extend_from_slice(&now_ms.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&roll.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&pitch.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&yaw.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&0f32.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&0f32.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&0f32.to_le_bytes());
|
||||||
|
build_v1_packet(payload.system_id, payload.component_id, 30, &msg, 39)
|
||||||
|
}
|
||||||
|
|
||||||
|
pub(crate) fn vfr_hud_packet(payload: &UasTelemetryPayload) -> Vec<u8> {
|
||||||
|
let heading = normalize_heading_deg(payload.heading_deg).round() as i16;
|
||||||
|
let throttle = if payload.flying { 50u16 } else { 0u16 };
|
||||||
|
|
||||||
|
let mut msg = Vec::with_capacity(20);
|
||||||
|
msg.extend_from_slice(&payload.groundspeed_mps.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&payload.groundspeed_mps.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&payload.alt_msl_m.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&0f32.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&heading.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&throttle.to_le_bytes());
|
||||||
|
build_v1_packet(payload.system_id, payload.component_id, 74, &msg, 20)
|
||||||
|
}
|
||||||
|
|
||||||
|
pub(crate) fn system_status_packet(system_id: u8, battery_remaining_pct: i8) -> Vec<u8> {
|
||||||
|
let fields = [
|
||||||
|
FieldSpec {
|
||||||
|
ty: "uint32_t",
|
||||||
|
name: "onboard_control_sensors_present",
|
||||||
|
array_len: 0,
|
||||||
|
},
|
||||||
|
FieldSpec {
|
||||||
|
ty: "uint32_t",
|
||||||
|
name: "onboard_control_sensors_enabled",
|
||||||
|
array_len: 0,
|
||||||
|
},
|
||||||
|
FieldSpec {
|
||||||
|
ty: "uint32_t",
|
||||||
|
name: "onboard_control_sensors_health",
|
||||||
|
array_len: 0,
|
||||||
|
},
|
||||||
|
FieldSpec {
|
||||||
|
ty: "uint16_t",
|
||||||
|
name: "load",
|
||||||
|
array_len: 0,
|
||||||
|
},
|
||||||
|
FieldSpec {
|
||||||
|
ty: "uint16_t",
|
||||||
|
name: "voltage_battery",
|
||||||
|
array_len: 0,
|
||||||
|
},
|
||||||
|
FieldSpec {
|
||||||
|
ty: "int16_t",
|
||||||
|
name: "current_battery",
|
||||||
|
array_len: 0,
|
||||||
|
},
|
||||||
|
FieldSpec {
|
||||||
|
ty: "uint16_t",
|
||||||
|
name: "drop_rate_comm",
|
||||||
|
array_len: 0,
|
||||||
|
},
|
||||||
|
FieldSpec {
|
||||||
|
ty: "uint16_t",
|
||||||
|
name: "errors_comm",
|
||||||
|
array_len: 0,
|
||||||
|
},
|
||||||
|
FieldSpec {
|
||||||
|
ty: "uint16_t",
|
||||||
|
name: "errors_count1",
|
||||||
|
array_len: 0,
|
||||||
|
},
|
||||||
|
FieldSpec {
|
||||||
|
ty: "uint16_t",
|
||||||
|
name: "errors_count2",
|
||||||
|
array_len: 0,
|
||||||
|
},
|
||||||
|
FieldSpec {
|
||||||
|
ty: "uint16_t",
|
||||||
|
name: "errors_count3",
|
||||||
|
array_len: 0,
|
||||||
|
},
|
||||||
|
FieldSpec {
|
||||||
|
ty: "uint16_t",
|
||||||
|
name: "errors_count4",
|
||||||
|
array_len: 0,
|
||||||
|
},
|
||||||
|
FieldSpec {
|
||||||
|
ty: "int8_t",
|
||||||
|
name: "battery_remaining",
|
||||||
|
array_len: 0,
|
||||||
|
},
|
||||||
|
];
|
||||||
|
let crc_extra = calculate_crc_extra("SYS_STATUS", &fields);
|
||||||
|
|
||||||
|
let sensors = 0x2000u32 | 0x4000u32 | 0x8000u32 | 0x20u32;
|
||||||
|
let mut msg = Vec::with_capacity(31);
|
||||||
|
msg.extend_from_slice(&sensors.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&sensors.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&sensors.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&500u16.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&12000u16.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&(-1i16).to_le_bytes());
|
||||||
|
msg.extend_from_slice(&0u16.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&0u16.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&0u16.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&0u16.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&0u16.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&0u16.to_le_bytes());
|
||||||
|
msg.push(battery_remaining_pct.clamp(0, 100) as u8);
|
||||||
|
|
||||||
|
build_v2_packet(system_id, AUTOPILOT_COMPONENT_ID, 1, &msg, crc_extra)
|
||||||
|
}
|
||||||
|
|
||||||
|
pub(crate) fn extended_sys_state_packet(system_id: u8, landed: bool) -> Vec<u8> {
|
||||||
|
let fields = [
|
||||||
|
FieldSpec {
|
||||||
|
ty: "uint8_t",
|
||||||
|
name: "vtol_state",
|
||||||
|
array_len: 0,
|
||||||
|
},
|
||||||
|
FieldSpec {
|
||||||
|
ty: "uint8_t",
|
||||||
|
name: "landed_state",
|
||||||
|
array_len: 0,
|
||||||
|
},
|
||||||
|
];
|
||||||
|
let crc_extra = calculate_crc_extra("EXTENDED_SYS_STATE", &fields);
|
||||||
|
|
||||||
|
let mut msg = Vec::with_capacity(2);
|
||||||
|
msg.push(MAV_LANDED_STATE_UNDEFINED);
|
||||||
|
msg.push(if landed {
|
||||||
|
MAV_LANDED_STATE_ON_GROUND
|
||||||
|
} else {
|
||||||
|
MAV_LANDED_STATE_IN_AIR
|
||||||
|
});
|
||||||
|
|
||||||
|
build_v2_packet(system_id, AUTOPILOT_COMPONENT_ID, 245, &msg, crc_extra)
|
||||||
|
}
|
||||||
|
|
||||||
|
pub(crate) fn autopilot_version_packet(system_id: u8, entity_uuid: &str) -> Vec<u8> {
|
||||||
|
let fields = [
|
||||||
|
FieldSpec {
|
||||||
|
ty: "uint64_t",
|
||||||
|
name: "capabilities",
|
||||||
|
array_len: 0,
|
||||||
|
},
|
||||||
|
FieldSpec {
|
||||||
|
ty: "uint32_t",
|
||||||
|
name: "flight_sw_version",
|
||||||
|
array_len: 0,
|
||||||
|
},
|
||||||
|
FieldSpec {
|
||||||
|
ty: "uint32_t",
|
||||||
|
name: "middleware_sw_version",
|
||||||
|
array_len: 0,
|
||||||
|
},
|
||||||
|
FieldSpec {
|
||||||
|
ty: "uint32_t",
|
||||||
|
name: "os_sw_version",
|
||||||
|
array_len: 0,
|
||||||
|
},
|
||||||
|
FieldSpec {
|
||||||
|
ty: "uint32_t",
|
||||||
|
name: "board_version",
|
||||||
|
array_len: 0,
|
||||||
|
},
|
||||||
|
FieldSpec {
|
||||||
|
ty: "uint8_t",
|
||||||
|
name: "flight_custom_version",
|
||||||
|
array_len: 8,
|
||||||
|
},
|
||||||
|
FieldSpec {
|
||||||
|
ty: "uint8_t",
|
||||||
|
name: "middleware_custom_version",
|
||||||
|
array_len: 8,
|
||||||
|
},
|
||||||
|
FieldSpec {
|
||||||
|
ty: "uint8_t",
|
||||||
|
name: "os_custom_version",
|
||||||
|
array_len: 8,
|
||||||
|
},
|
||||||
|
FieldSpec {
|
||||||
|
ty: "uint16_t",
|
||||||
|
name: "vendor_id",
|
||||||
|
array_len: 0,
|
||||||
|
},
|
||||||
|
FieldSpec {
|
||||||
|
ty: "uint16_t",
|
||||||
|
name: "product_id",
|
||||||
|
array_len: 0,
|
||||||
|
},
|
||||||
|
FieldSpec {
|
||||||
|
ty: "uint64_t",
|
||||||
|
name: "uid",
|
||||||
|
array_len: 0,
|
||||||
|
},
|
||||||
|
];
|
||||||
|
let crc_extra = calculate_crc_extra("AUTOPILOT_VERSION", &fields);
|
||||||
|
|
||||||
|
let capabilities = MAV_PROTOCOL_CAPABILITY_MISSION_INT
|
||||||
|
| MAV_PROTOCOL_CAPABILITY_COMMAND_INT
|
||||||
|
| MAV_PROTOCOL_CAPABILITY_FTP
|
||||||
|
| MAV_PROTOCOL_CAPABILITY_SET_POSITION_TARGET_GLOBAL_INT
|
||||||
|
| MAV_PROTOCOL_CAPABILITY_MAVLINK2
|
||||||
|
| MAV_PROTOCOL_CAPABILITY_COMPONENT_IMPLEMENTS_GIMBAL_MANAGER;
|
||||||
|
let uid = uid64_from_uuid(entity_uuid);
|
||||||
|
let uid2 = uid2_from_uuid(entity_uuid);
|
||||||
|
|
||||||
|
let mut msg = Vec::with_capacity(78);
|
||||||
|
msg.extend_from_slice(&capabilities.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&0x010100FFu32.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&0u32.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&0u32.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&0u32.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&[0u8; 8]);
|
||||||
|
msg.extend_from_slice(&[0u8; 8]);
|
||||||
|
msg.extend_from_slice(&[0u8; 8]);
|
||||||
|
msg.extend_from_slice(&0x5441u16.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&0x5541u16.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&uid.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&uid2);
|
||||||
|
|
||||||
|
build_v2_packet(system_id, AUTOPILOT_COMPONENT_ID, 148, &msg, crc_extra)
|
||||||
|
}
|
||||||
|
|
||||||
|
pub(crate) fn home_position_packet(
|
||||||
|
system_id: u8,
|
||||||
|
lat_deg: f64,
|
||||||
|
lon_deg: f64,
|
||||||
|
alt_msl_m: f32,
|
||||||
|
heading_deg: f32,
|
||||||
|
) -> Vec<u8> {
|
||||||
|
let yaw = normalize_heading_deg(heading_deg).to_radians();
|
||||||
|
let q = [(yaw * 0.5).cos(), 0.0f32, 0.0f32, (yaw * 0.5).sin()];
|
||||||
|
|
||||||
|
let mut msg = Vec::with_capacity(52);
|
||||||
|
msg.extend_from_slice(&((lat_deg * 1e7).round() as i32).to_le_bytes());
|
||||||
|
msg.extend_from_slice(&((lon_deg * 1e7).round() as i32).to_le_bytes());
|
||||||
|
msg.extend_from_slice(&((alt_msl_m * 1000.0).round() as i32).to_le_bytes());
|
||||||
|
msg.extend_from_slice(&0f32.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&0f32.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&0f32.to_le_bytes());
|
||||||
|
for value in q {
|
||||||
|
msg.extend_from_slice(&value.to_le_bytes());
|
||||||
|
}
|
||||||
|
msg.extend_from_slice(&0f32.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&0f32.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&0f32.to_le_bytes());
|
||||||
|
|
||||||
|
build_v2_packet(system_id, AUTOPILOT_COMPONENT_ID, 242, &msg, 85)
|
||||||
|
}
|
||||||
|
|
||||||
|
pub(crate) fn component_heartbeat_packet(
|
||||||
|
system_id: u8,
|
||||||
|
component_id: u8,
|
||||||
|
component_type: u8,
|
||||||
|
) -> Vec<u8> {
|
||||||
|
let mut msg = Vec::with_capacity(9);
|
||||||
|
msg.extend_from_slice(&0u32.to_le_bytes());
|
||||||
|
msg.push(component_type);
|
||||||
|
msg.push(MAV_AUTOPILOT_INVALID);
|
||||||
|
msg.push(0);
|
||||||
|
msg.push(MAV_STATE_ACTIVE);
|
||||||
|
msg.push(3);
|
||||||
|
build_v2_packet(system_id, component_id, 0, &msg, 50)
|
||||||
|
}
|
||||||
|
|
||||||
|
pub(crate) fn camera_information_packet_for_component(
|
||||||
|
system_id: u8,
|
||||||
|
component_id: u8,
|
||||||
|
callsign: &str,
|
||||||
|
gimbal_device_id: u8,
|
||||||
|
) -> Vec<u8> {
|
||||||
|
let vendor = fixed_string::<32>("ArmaTAK");
|
||||||
|
let model = fixed_string::<32>(callsign);
|
||||||
|
let cam_definition_uri = fixed_string::<140>("");
|
||||||
|
let flags = CAMERA_CAP_FLAGS_CAPTURE_VIDEO
|
||||||
|
| CAMERA_CAP_FLAGS_CAPTURE_IMAGE
|
||||||
|
| CAMERA_CAP_FLAGS_HAS_MODES
|
||||||
|
| CAMERA_CAP_FLAGS_HAS_BASIC_ZOOM
|
||||||
|
| CAMERA_CAP_FLAGS_HAS_VIDEO_STREAM;
|
||||||
|
|
||||||
|
let mut msg = Vec::with_capacity(235);
|
||||||
|
msg.extend_from_slice(&(Utc::now().timestamp_millis().max(0) as u32).to_le_bytes());
|
||||||
|
msg.extend_from_slice(&0x010100FFu32.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&2.8f32.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&6.4f32.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&4.8f32.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&flags.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&1280u16.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&720u16.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&0u16.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&vendor);
|
||||||
|
msg.extend_from_slice(&model);
|
||||||
|
msg.push(0);
|
||||||
|
msg.extend_from_slice(&cam_definition_uri);
|
||||||
|
msg.push(gimbal_device_id);
|
||||||
|
msg.push(0);
|
||||||
|
|
||||||
|
build_v2_packet(system_id, component_id, 259, &msg, 92)
|
||||||
|
}
|
||||||
|
|
||||||
|
pub(crate) fn video_stream_information_packet_for_component(
|
||||||
|
system_id: u8,
|
||||||
|
component_id: u8,
|
||||||
|
callsign: &str,
|
||||||
|
video_uri: &str,
|
||||||
|
hfov_deg: f32,
|
||||||
|
stream_id: u8,
|
||||||
|
stream_count: u8,
|
||||||
|
thermal: bool,
|
||||||
|
) -> Vec<u8> {
|
||||||
|
let stream_type = if video_uri.starts_with("rtsp://") {
|
||||||
|
VIDEO_STREAM_TYPE_RTSP
|
||||||
|
} else if video_uri.starts_with("rtp://") {
|
||||||
|
VIDEO_STREAM_TYPE_RTPUDP
|
||||||
|
} else if video_uri.starts_with("tcp://") {
|
||||||
|
VIDEO_STREAM_TYPE_TCP_MPEG
|
||||||
|
} else if video_uri.starts_with("mpegts://") || video_uri.starts_with("udp://") {
|
||||||
|
VIDEO_STREAM_TYPE_MPEG_TS
|
||||||
|
} else {
|
||||||
|
VIDEO_STREAM_TYPE_RTSP
|
||||||
|
};
|
||||||
|
|
||||||
|
let name = fixed_string::<32>(callsign);
|
||||||
|
let uri = fixed_string::<160>(video_uri);
|
||||||
|
let flags = VIDEO_STREAM_STATUS_FLAGS_RUNNING | if thermal { 2 } else { 0 };
|
||||||
|
|
||||||
|
let mut msg = Vec::with_capacity(208);
|
||||||
|
msg.extend_from_slice(&30f32.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&4_000_000u32.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&flags.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&1280u16.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&720u16.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&0u16.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&(hfov_deg.clamp(1.0, 360.0).round() as u16).to_le_bytes());
|
||||||
|
msg.push(stream_id);
|
||||||
|
msg.push(stream_count);
|
||||||
|
msg.push(stream_type);
|
||||||
|
msg.extend_from_slice(&name);
|
||||||
|
msg.extend_from_slice(&uri);
|
||||||
|
msg.push(VIDEO_STREAM_ENCODING_H264);
|
||||||
|
msg.push(0);
|
||||||
|
|
||||||
|
build_v2_packet(system_id, component_id, 269, &msg, 109)
|
||||||
|
}
|
||||||
|
|
||||||
|
pub(crate) fn video_stream_status_packet_for_component(
|
||||||
|
system_id: u8,
|
||||||
|
component_id: u8,
|
||||||
|
hfov_deg: f32,
|
||||||
|
stream_id: u8,
|
||||||
|
thermal: bool,
|
||||||
|
) -> Vec<u8> {
|
||||||
|
let flags = VIDEO_STREAM_STATUS_FLAGS_RUNNING | if thermal { 2 } else { 0 };
|
||||||
|
let mut msg = Vec::with_capacity(19);
|
||||||
|
msg.extend_from_slice(&30f32.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&4_000_000u32.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&flags.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&1280u16.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&720u16.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&0u16.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&(hfov_deg.clamp(1.0, 360.0).round() as u16).to_le_bytes());
|
||||||
|
msg.push(stream_id);
|
||||||
|
msg.push(0);
|
||||||
|
|
||||||
|
build_v2_packet(system_id, component_id, 270, &msg, 59)
|
||||||
|
}
|
||||||
|
|
||||||
|
pub(crate) fn mount_orientation_packet_for_component(
|
||||||
|
system_id: u8,
|
||||||
|
component_id: u8,
|
||||||
|
pitch_deg: f32,
|
||||||
|
yaw_deg: f32,
|
||||||
|
) -> Vec<u8> {
|
||||||
|
let mut msg = Vec::with_capacity(16);
|
||||||
|
msg.extend_from_slice(&(Utc::now().timestamp_millis().max(0) as u32).to_le_bytes());
|
||||||
|
msg.extend_from_slice(&pitch_deg.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&0f32.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&normalize_heading_deg(yaw_deg).to_le_bytes());
|
||||||
|
|
||||||
|
build_v2_packet(system_id, component_id, 265, &msg, 26)
|
||||||
|
}
|
||||||
|
|
||||||
|
pub(crate) fn camera_fov_status_packet_for_component(
|
||||||
|
system_id: u8,
|
||||||
|
component_id: u8,
|
||||||
|
lat_camera_deg: f64,
|
||||||
|
lon_camera_deg: f64,
|
||||||
|
alt_camera_msl_m: f32,
|
||||||
|
lat_image_deg: f64,
|
||||||
|
lon_image_deg: f64,
|
||||||
|
alt_image_msl_m: f32,
|
||||||
|
roll_deg: f32,
|
||||||
|
pitch_deg: f32,
|
||||||
|
yaw_deg: f32,
|
||||||
|
hfov_deg: f32,
|
||||||
|
vfov_deg: f32,
|
||||||
|
) -> Vec<u8> {
|
||||||
|
let q = attitude_quaternion(roll_deg, pitch_deg, yaw_deg);
|
||||||
|
let mut msg = Vec::with_capacity(53);
|
||||||
|
msg.extend_from_slice(&(Utc::now().timestamp_millis().max(0) as u32).to_le_bytes());
|
||||||
|
msg.extend_from_slice(&((lat_camera_deg * 1e7).round() as i32).to_le_bytes());
|
||||||
|
msg.extend_from_slice(&((lon_camera_deg * 1e7).round() as i32).to_le_bytes());
|
||||||
|
msg.extend_from_slice(&((alt_camera_msl_m * 1000.0).round() as i32).to_le_bytes());
|
||||||
|
msg.extend_from_slice(&((lat_image_deg * 1e7).round() as i32).to_le_bytes());
|
||||||
|
msg.extend_from_slice(&((lon_image_deg * 1e7).round() as i32).to_le_bytes());
|
||||||
|
msg.extend_from_slice(&((alt_image_msl_m * 1000.0).round() as i32).to_le_bytes());
|
||||||
|
for value in q {
|
||||||
|
msg.extend_from_slice(&value.to_le_bytes());
|
||||||
|
}
|
||||||
|
msg.extend_from_slice(&hfov_deg.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&vfov_deg.to_le_bytes());
|
||||||
|
msg.push(0);
|
||||||
|
|
||||||
|
build_v2_packet(system_id, component_id, 271, &msg, 22)
|
||||||
|
}
|
||||||
|
|
||||||
|
pub(crate) fn mount_status_packet(
|
||||||
|
system_id: u8,
|
||||||
|
pitch_deg: f32,
|
||||||
|
roll_deg: f32,
|
||||||
|
relative_yaw_deg: f32,
|
||||||
|
) -> Vec<u8> {
|
||||||
|
let mut msg = Vec::with_capacity(15);
|
||||||
|
msg.extend_from_slice(&((pitch_deg * 100.0).round() as i32).to_le_bytes());
|
||||||
|
msg.extend_from_slice(&((roll_deg * 100.0).round() as i32).to_le_bytes());
|
||||||
|
msg.extend_from_slice(&((relative_yaw_deg * 100.0).round() as i32).to_le_bytes());
|
||||||
|
msg.push(system_id);
|
||||||
|
msg.push(GIMBAL_COMPONENT_ID);
|
||||||
|
msg.push(2);
|
||||||
|
|
||||||
|
build_v2_packet(system_id, AUTOPILOT_COMPONENT_ID, 158, &msg, 134)
|
||||||
|
}
|
||||||
|
|
||||||
|
pub(crate) fn gimbal_manager_information_packet(system_id: u8) -> Vec<u8> {
|
||||||
|
let fields = [
|
||||||
|
FieldSpec {
|
||||||
|
ty: "uint32_t",
|
||||||
|
name: "time_boot_ms",
|
||||||
|
array_len: 0,
|
||||||
|
},
|
||||||
|
FieldSpec {
|
||||||
|
ty: "uint32_t",
|
||||||
|
name: "cap_flags",
|
||||||
|
array_len: 0,
|
||||||
|
},
|
||||||
|
FieldSpec {
|
||||||
|
ty: "float",
|
||||||
|
name: "roll_min",
|
||||||
|
array_len: 0,
|
||||||
|
},
|
||||||
|
FieldSpec {
|
||||||
|
ty: "float",
|
||||||
|
name: "roll_max",
|
||||||
|
array_len: 0,
|
||||||
|
},
|
||||||
|
FieldSpec {
|
||||||
|
ty: "float",
|
||||||
|
name: "pitch_min",
|
||||||
|
array_len: 0,
|
||||||
|
},
|
||||||
|
FieldSpec {
|
||||||
|
ty: "float",
|
||||||
|
name: "pitch_max",
|
||||||
|
array_len: 0,
|
||||||
|
},
|
||||||
|
FieldSpec {
|
||||||
|
ty: "float",
|
||||||
|
name: "yaw_min",
|
||||||
|
array_len: 0,
|
||||||
|
},
|
||||||
|
FieldSpec {
|
||||||
|
ty: "float",
|
||||||
|
name: "yaw_max",
|
||||||
|
array_len: 0,
|
||||||
|
},
|
||||||
|
FieldSpec {
|
||||||
|
ty: "uint8_t",
|
||||||
|
name: "gimbal_device_id",
|
||||||
|
array_len: 0,
|
||||||
|
},
|
||||||
|
];
|
||||||
|
let crc_extra = calculate_crc_extra("GIMBAL_MANAGER_INFORMATION", &fields);
|
||||||
|
|
||||||
|
let mut msg = Vec::with_capacity(33);
|
||||||
|
msg.extend_from_slice(&(Utc::now().timestamp_millis().max(0) as u32).to_le_bytes());
|
||||||
|
msg.extend_from_slice(&GIMBAL_MANAGER_CAP_FLAGS_BASIC_PITCH_YAW.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&0f32.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&0f32.to_le_bytes());
|
||||||
|
msg.extend_from_slice(&(-90f32).to_radians().to_le_bytes());
|
||||||
|
msg.extend_from_slice(&30f32.to_radians().to_le_bytes());
|
||||||
|
msg.extend_from_slice(&(-180f32).to_radians().to_le_bytes());
|
||||||
|
msg.extend_from_slice(&180f32.to_radians().to_le_bytes());
|
||||||
|
msg.push(GIMBAL_COMPONENT_ID);
|
||||||
|
|
||||||
|
build_v2_packet(system_id, GIMBAL_COMPONENT_ID, 280, &msg, crc_extra)
|
||||||
|
}
|
||||||
|
|
||||||
|
fn attitude_quaternion(roll_deg: f32, pitch_deg: f32, yaw_deg: f32) -> [f32; 4] {
|
||||||
|
let (roll, pitch, yaw) = (
|
||||||
|
roll_deg.to_radians(),
|
||||||
|
pitch_deg.to_radians(),
|
||||||
|
normalize_heading_deg(yaw_deg).to_radians(),
|
||||||
|
);
|
||||||
|
let (sr, cr) = (roll * 0.5).sin_cos();
|
||||||
|
let (sp, cp) = (pitch * 0.5).sin_cos();
|
||||||
|
let (sy, cy) = (yaw * 0.5).sin_cos();
|
||||||
|
|
||||||
|
[
|
||||||
|
cr * cp * cy + sr * sp * sy,
|
||||||
|
sr * cp * cy - cr * sp * sy,
|
||||||
|
cr * sp * cy + sr * cp * sy,
|
||||||
|
cr * cp * sy - sr * sp * cy,
|
||||||
|
]
|
||||||
|
}
|
||||||
@@ -0,0 +1,256 @@
|
|||||||
|
use arma_rs::{FromArma, FromArmaError};
|
||||||
|
|
||||||
|
pub struct UasTelemetryPayload {
|
||||||
|
pub address: String,
|
||||||
|
pub system_id: u8,
|
||||||
|
pub component_id: u8,
|
||||||
|
pub vehicle_type: u8,
|
||||||
|
pub lat_deg: f64,
|
||||||
|
pub lon_deg: f64,
|
||||||
|
pub alt_msl_m: f32,
|
||||||
|
pub rel_alt_m: f32,
|
||||||
|
pub heading_deg: f32,
|
||||||
|
pub groundspeed_mps: f32,
|
||||||
|
pub roll_deg: f32,
|
||||||
|
pub pitch_deg: f32,
|
||||||
|
pub yaw_deg: f32,
|
||||||
|
pub flying: bool,
|
||||||
|
}
|
||||||
|
|
||||||
|
#[allow(dead_code)]
|
||||||
|
pub struct UasSystemPayload {
|
||||||
|
pub address: String,
|
||||||
|
pub entity_uuid: String,
|
||||||
|
pub callsign: String,
|
||||||
|
pub vehicle_type: u8,
|
||||||
|
pub lat_deg: f64,
|
||||||
|
pub lon_deg: f64,
|
||||||
|
pub alt_msl_m: f32,
|
||||||
|
pub rel_alt_m: f32,
|
||||||
|
pub heading_deg: f32,
|
||||||
|
pub groundspeed_mps: f32,
|
||||||
|
pub roll_deg: f32,
|
||||||
|
pub pitch_deg: f32,
|
||||||
|
pub yaw_deg: f32,
|
||||||
|
pub flying: bool,
|
||||||
|
pub landed: bool,
|
||||||
|
pub gimbal_roll_deg: f32,
|
||||||
|
pub gimbal_pitch_deg: f32,
|
||||||
|
pub gimbal_yaw_deg: f32,
|
||||||
|
pub video_uri: String,
|
||||||
|
pub hfov_deg: f32,
|
||||||
|
pub vfov_deg: f32,
|
||||||
|
pub image_lat_deg: f64,
|
||||||
|
pub image_lon_deg: f64,
|
||||||
|
pub image_alt_msl_m: f32,
|
||||||
|
pub has_turret_camera: bool,
|
||||||
|
pub battery_remaining_pct: i8,
|
||||||
|
}
|
||||||
|
|
||||||
|
impl FromArma for UasTelemetryPayload {
|
||||||
|
fn from_arma(data: String) -> Result<Self, FromArmaError> {
|
||||||
|
let (
|
||||||
|
address,
|
||||||
|
system_id,
|
||||||
|
component_id,
|
||||||
|
vehicle_type,
|
||||||
|
lat_deg,
|
||||||
|
lon_deg,
|
||||||
|
alt_msl_m,
|
||||||
|
rel_alt_m,
|
||||||
|
heading_deg,
|
||||||
|
groundspeed_mps,
|
||||||
|
roll_deg,
|
||||||
|
pitch_deg,
|
||||||
|
yaw_deg,
|
||||||
|
flying,
|
||||||
|
) = <(
|
||||||
|
String,
|
||||||
|
i32,
|
||||||
|
i32,
|
||||||
|
i32,
|
||||||
|
f64,
|
||||||
|
f64,
|
||||||
|
f32,
|
||||||
|
f32,
|
||||||
|
f32,
|
||||||
|
f32,
|
||||||
|
f32,
|
||||||
|
f32,
|
||||||
|
f32,
|
||||||
|
i32,
|
||||||
|
)>::from_arma(data)?;
|
||||||
|
|
||||||
|
Ok(Self {
|
||||||
|
address,
|
||||||
|
system_id: system_id.clamp(1, 255) as u8,
|
||||||
|
component_id: component_id.clamp(1, 255) as u8,
|
||||||
|
vehicle_type: vehicle_type.clamp(0, 255) as u8,
|
||||||
|
lat_deg,
|
||||||
|
lon_deg,
|
||||||
|
alt_msl_m,
|
||||||
|
rel_alt_m,
|
||||||
|
heading_deg,
|
||||||
|
groundspeed_mps,
|
||||||
|
roll_deg,
|
||||||
|
pitch_deg,
|
||||||
|
yaw_deg,
|
||||||
|
flying: flying != 0,
|
||||||
|
})
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
impl FromArma for UasSystemPayload {
|
||||||
|
fn from_arma(data: String) -> Result<Self, FromArmaError> {
|
||||||
|
let (
|
||||||
|
address,
|
||||||
|
entity_uuid,
|
||||||
|
callsign,
|
||||||
|
vehicle_type,
|
||||||
|
lat_deg,
|
||||||
|
lon_deg,
|
||||||
|
alt_msl_m,
|
||||||
|
rel_alt_m,
|
||||||
|
heading_deg,
|
||||||
|
groundspeed_mps,
|
||||||
|
roll_deg,
|
||||||
|
pitch_deg,
|
||||||
|
yaw_deg,
|
||||||
|
flying,
|
||||||
|
landed,
|
||||||
|
gimbal_roll_deg,
|
||||||
|
gimbal_pitch_deg,
|
||||||
|
gimbal_yaw_deg,
|
||||||
|
video_uri,
|
||||||
|
hfov_deg,
|
||||||
|
vfov_deg,
|
||||||
|
image_lat_deg,
|
||||||
|
image_lon_deg,
|
||||||
|
image_alt_msl_m,
|
||||||
|
has_turret_camera,
|
||||||
|
battery_remaining_pct,
|
||||||
|
) = <(
|
||||||
|
String,
|
||||||
|
String,
|
||||||
|
String,
|
||||||
|
i32,
|
||||||
|
f64,
|
||||||
|
f64,
|
||||||
|
f32,
|
||||||
|
f32,
|
||||||
|
f32,
|
||||||
|
f32,
|
||||||
|
f32,
|
||||||
|
f32,
|
||||||
|
f32,
|
||||||
|
i32,
|
||||||
|
i32,
|
||||||
|
f32,
|
||||||
|
f32,
|
||||||
|
f32,
|
||||||
|
String,
|
||||||
|
f32,
|
||||||
|
f32,
|
||||||
|
f64,
|
||||||
|
f64,
|
||||||
|
f32,
|
||||||
|
i32,
|
||||||
|
i32,
|
||||||
|
)>::from_arma(data)?;
|
||||||
|
|
||||||
|
Ok(Self {
|
||||||
|
address,
|
||||||
|
entity_uuid,
|
||||||
|
callsign,
|
||||||
|
vehicle_type: vehicle_type.clamp(0, 255) as u8,
|
||||||
|
lat_deg,
|
||||||
|
lon_deg,
|
||||||
|
alt_msl_m,
|
||||||
|
rel_alt_m,
|
||||||
|
heading_deg,
|
||||||
|
groundspeed_mps,
|
||||||
|
roll_deg,
|
||||||
|
pitch_deg,
|
||||||
|
yaw_deg,
|
||||||
|
flying: flying != 0,
|
||||||
|
landed: landed != 0,
|
||||||
|
gimbal_roll_deg,
|
||||||
|
gimbal_pitch_deg,
|
||||||
|
gimbal_yaw_deg,
|
||||||
|
video_uri,
|
||||||
|
hfov_deg,
|
||||||
|
vfov_deg,
|
||||||
|
image_lat_deg,
|
||||||
|
image_lon_deg,
|
||||||
|
image_alt_msl_m,
|
||||||
|
has_turret_camera: has_turret_camera != 0,
|
||||||
|
battery_remaining_pct: battery_remaining_pct.clamp(0, 100) as i8,
|
||||||
|
})
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
#[cfg(test)]
|
||||||
|
mod tests {
|
||||||
|
use super::{UasSystemPayload, UasTelemetryPayload};
|
||||||
|
use arma_rs::FromArma;
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn parses_and_clamps_uas_telemetry_payload() {
|
||||||
|
let payload = UasTelemetryPayload::from_arma(
|
||||||
|
r#"["127.0.0.1:14550",0,999,-1,-30.1,-51.2,100.5,25.25,361.0,12.5,1.0,2.0,3.0,1]"#
|
||||||
|
.to_string(),
|
||||||
|
)
|
||||||
|
.expect("telemetry payload should parse");
|
||||||
|
|
||||||
|
assert_eq!(payload.address, "127.0.0.1:14550");
|
||||||
|
assert_eq!(payload.system_id, 1);
|
||||||
|
assert_eq!(payload.component_id, 255);
|
||||||
|
assert_eq!(payload.vehicle_type, 0);
|
||||||
|
assert_eq!(payload.lat_deg, -30.1);
|
||||||
|
assert_eq!(payload.lon_deg, -51.2);
|
||||||
|
assert_eq!(payload.alt_msl_m, 100.5);
|
||||||
|
assert_eq!(payload.rel_alt_m, 25.25);
|
||||||
|
assert_eq!(payload.heading_deg, 361.0);
|
||||||
|
assert_eq!(payload.groundspeed_mps, 12.5);
|
||||||
|
assert_eq!(payload.roll_deg, 1.0);
|
||||||
|
assert_eq!(payload.pitch_deg, 2.0);
|
||||||
|
assert_eq!(payload.yaw_deg, 3.0);
|
||||||
|
assert!(payload.flying);
|
||||||
|
}
|
||||||
|
|
||||||
|
#[test]
|
||||||
|
fn parses_and_clamps_full_uas_system_payload() {
|
||||||
|
let payload = UasSystemPayload::from_arma(
|
||||||
|
r#"["10.0.0.1:14550","00112233-4455-6677-8899-aabbccddeeff","Falcon",300,-30.1,-51.2,100.5,25.25,90.0,12.5,1.0,2.0,3.0,0,1,4.0,5.0,6.0,"rtsp://video.example.test:8554/live",60.0,40.0,-30.2,-51.3,50.0,1,200]"#
|
||||||
|
.to_string(),
|
||||||
|
)
|
||||||
|
.expect("system payload should parse");
|
||||||
|
|
||||||
|
assert_eq!(payload.address, "10.0.0.1:14550");
|
||||||
|
assert_eq!(payload.entity_uuid, "00112233-4455-6677-8899-aabbccddeeff");
|
||||||
|
assert_eq!(payload.callsign, "Falcon");
|
||||||
|
assert_eq!(payload.vehicle_type, 255);
|
||||||
|
assert_eq!(payload.lat_deg, -30.1);
|
||||||
|
assert_eq!(payload.lon_deg, -51.2);
|
||||||
|
assert_eq!(payload.alt_msl_m, 100.5);
|
||||||
|
assert_eq!(payload.rel_alt_m, 25.25);
|
||||||
|
assert_eq!(payload.heading_deg, 90.0);
|
||||||
|
assert_eq!(payload.groundspeed_mps, 12.5);
|
||||||
|
assert_eq!(payload.roll_deg, 1.0);
|
||||||
|
assert_eq!(payload.pitch_deg, 2.0);
|
||||||
|
assert_eq!(payload.yaw_deg, 3.0);
|
||||||
|
assert!(!payload.flying);
|
||||||
|
assert!(payload.landed);
|
||||||
|
assert_eq!(payload.gimbal_roll_deg, 4.0);
|
||||||
|
assert_eq!(payload.gimbal_pitch_deg, 5.0);
|
||||||
|
assert_eq!(payload.gimbal_yaw_deg, 6.0);
|
||||||
|
assert_eq!(payload.video_uri, "rtsp://video.example.test:8554/live");
|
||||||
|
assert_eq!(payload.hfov_deg, 60.0);
|
||||||
|
assert_eq!(payload.vfov_deg, 40.0);
|
||||||
|
assert_eq!(payload.image_lat_deg, -30.2);
|
||||||
|
assert_eq!(payload.image_lon_deg, -51.3);
|
||||||
|
assert_eq!(payload.image_alt_msl_m, 50.0);
|
||||||
|
assert!(payload.has_turret_camera);
|
||||||
|
assert_eq!(payload.battery_remaining_pct, 100);
|
||||||
|
}
|
||||||
|
}
|
||||||
Some files were not shown because too many files have changed in this diff Show More
Reference in New Issue
Block a user