asojogrvc / smart-flies

HMWTPP Planner
https://arxiv.org/abs/2410.20849
MIT License
0 stars 0 forks source link

Yaw problem in vegetation mission, pointer mission in new version. #9

Closed arpoma16 closed 2 days ago

arpoma16 commented 3 days ago

look the image the have problem issues

arpoma16 commented 3 days ago

puedes probar con cualquier mission por ejemplo: esta da el mismo resultado , muestra el yaw erroneo

{
    "id": 31801616,
    "case": 1,
    "meteo": [],
    "locations": [
        {
            "name": "Elements",
            "items": [
                {
                    "latitude": 37.1902109849165,
                    "longitude": -6.697038132129983
                }
            ]
        }
    ],
    "devices": [
        {
            "settings": {
                "base": [
                    37.1938071382897,
                    -6.702911873416099,
                    "base"
                ],
                "inspection_speed": 7,
                "navigation_speed": 15,
                "vertical_offset": 15,
                "horizontal_offset": 10,
                "tower_height": 12,
                "security_height": 10,
                "orbital_points": 5,
                "landing_mode": 2
            },
            "id": "uav_14",
            "category": "dji_M300"
        },
        {
            "settings": {
                "base": [
                    37.04392450222122,
                    -6.568677029462045,
                    "base"
                ],
                "inspection_speed": 7,
                "navigation_speed": 15,
                "vertical_offset": 15,
                "horizontal_offset": 10,
                "tower_height": 12,
                "security_height": 10,
                "orbital_points": 5,
                "landing_mode": 2
            },
            "id": "uav_3",
            "category": "px4"
        },
        {
            "settings": {
                "base": [
                    37.1340964847625,
                    -6.472237657544976,
                    "base"
                ],
                "inspection_speed": 7,
                "navigation_speed": 15,
                "vertical_offset": 15,
                "horizontal_offset": 10,
                "tower_height": 12,
                "security_height": 10,
                "orbital_points": 5,
                "landing_mode": 2
            },
            "id": "uav_15",
            "category": "dji_M300"
        },
        {
            "settings": {
                "base": [
                    37.134972445278365,
                    -6.472774411805773
                ],
                "inspection_speed": 7,
                "navigation_speed": 15,
                "vertical_offset": 15,
                "horizontal_offset": 10,
                "tower_height": 12,
                "security_height": 10,
                "orbital_points": 5,
                "landing_mode": 2
            },
            "id": "uav_17",
            "category": "dji_M600"
        }
    ]
}
asojogrvc commented 3 days ago

Es un problema con la forma en la que cálculo el norte en la nuevas coordenadas EPSG3035. Tengo que buscar una forma nueva de calcular la dirección del yaw. Posiblemente lo que haga sea pasar a LatLong y desde ahí computar el yaw.

arpoma16 commented 3 days ago

Screenshot from 2024-10-29 16-33-42

la de linea tambien parece que va medio mal , cambia de la altura de inspecion a la de desplazamiento a la mitad de la inspeccion.

{
    "id": "47611804",
    "case": 0,
    "meteo": [],
    "locations": [
        {
            "name": "Elements",
            "items": [
                {
                    "latitude": 37.14163123246583,
                    "longitude": -6.456867004483156
                },
                {
                    "latitude": 37.14191622873606,
                    "longitude": -6.459141156573338
                },
                {
                    "latitude": 37.14220105474247,
                    "longitude": -6.461367806003335
                },
                {
                    "latitude": 37.14249465570466,
                    "longitude": -6.46368361778925
                },
                {
                    "latitude": 37.14280659694354,
                    "longitude": -6.466046539531733
                }
            ]
        }
    ],
    "devices": [
        {
            "settings": {
                "base": [
                    37.1938071382897,
                    -6.702911873416099,
                    "base"
                ],
                "inspection_speed": 7,
                "navigation_speed": 15,
                "vertical_offset": 10,
                "horizontal_offset": 10,
                "tower_height": 10,
                "security_height": 10,
                "landing_mode": 2
            },
            "id": "uav_14",
            "category": "dji_M300"
        },
        {
            "settings": {
                "base": [
                    37.04392450222122,
                    -6.568677029462045,
                    "base"
                ],
                "inspection_speed": 7,
                "navigation_speed": 15,
                "vertical_offset": 10,
                "horizontal_offset": 10,
                "tower_height": 10,
                "security_height": 10,
                "landing_mode": 2
            },
            "id": "uav_3",
            "category": "px4"
        },
        {
            "settings": {
                "base": [
                    37.1340964847625,
                    -6.472237657544976,
                    "base"
                ],
                "inspection_speed": 7,
                "navigation_speed": 15,
                "vertical_offset": 10,
                "horizontal_offset": 10,
                "tower_height": 10,
                "security_height": 10,
                "landing_mode": 2
            },
            "id": "uav_15",
            "category": "dji_M300"
        },
        {
            "settings": {
                "base": [
                    37.134972445278365,
                    -6.472774411805773
                ],
                "inspection_speed": 7,
                "navigation_speed": 15,
                "vertical_offset": 10,
                "horizontal_offset": 10,
                "tower_height": 10,
                "security_height": 10,
                "landing_mode": 2
            },
            "id": "uav_17",
            "category": "dji_M600"
        }
    ]
}