고도 이해
저작권: 쿼드(QUAD) 드론연구소 https://smartstore.naver.com/maponarooo
Last updated
저작권: 쿼드(QUAD) 드론연구소 https://smartstore.naver.com/maponarooo
Last updated
ArduPilot 문서에서는 "고도"라는 단어를 다양한 방식과 맥락에서 자주 사용합니다. 모든 "고도"가 같은 것을 의미하는 것은 아니며 주어진 상황에서 고도가 의미하는 바를 잘 이해하는 것이 예상되는 작동 및 동작을 이해하는 데 중요합니다.
ORIGIN 및 HOME은 GPS에서 지상 초기화 중에 설정되며 일반적으로 동일한 위치이지만 사용자는 Mission Planner를 통해 비행 중에 HOME 위치를 이동할 수 있지만(다른 RTL 지점에 대해) 의도적으로 재설정하지 않는 한 Origin은 항상 동일하게 유지됩니다. .
위의 다이어그램에는 다양한 유형의 "고도"가 표시됩니다.
ASL: (평균) 해수면 위의 고도 - 세계의 평균 해수면 위의 거리로 표현되는 차량의 고도.
AGL: 지면 위 고도: 바로 아래에 있는 차량 위의 고도.
상대: HOME/ORIGIN 위치의 고도 위의 상대 고도. 이것이 지상국과 OSD에 차량의 고도로 표시됩니다.
Terrain ALT: 지형 위치의 해수면 위 높이(asl). 여기에는 때때로 지형의 지상 고도에 대한 자연적 또는 인공적 추가가 포함되지만 항상 그런 것은 아닙니다.
예상 ALT: 고도 제어 모드(비행기: FBWB/AUTO/GUIDED/CRUISE/LOITER/CIRCLE)에서 목표 ALT를 유지하거나 얻기 위해 차량의 고도 컨트롤러가 내부적으로 사용하는 ORIGIN 이상의 차량 상대 고도에 대한 자동조종장치의 추정치, 헬리콥터: 알홀드/서클/로이터/가이드/자동/드리프트)
Target ALT: 고도 제어 모드에서 원하는 고도. 파일럿 입력(예: ALTHOLD) 또는 내비게이션 컨트롤러(예: AUTO)에서
위의 단순화된 다이어그램은 ArduPilot에서 고도 제어가 구현되는 방법을 보여줍니다.
EKF 하위 시스템은 내비게이션 및 제어 시스템이 제대로 작동할 수 있도록 차량의 자세, 속도, 위치 및 고도 추정치를 생성하는 역할을 합니다. EKF는 IMU, GPS 및 BARO 센서 입력을 가져와 통합하여 이러한 추정치를 제공하며, 그 중 하나가 추정 ALT입니다.
그런 다음 차량의 고도 제어 시스템에 입력되어 고도 제어 모드에서 Target ALT를 일치시키려고 시도합니다.
Target ALT는 차량 모드에 따라 다양한 출처에서 나올 수 있습니다. 예를 들어 비행기의 FBWB 모드에서 피치 스틱은 목표 ALT를 높이거나 낮추는 반면 자동 모드에서는 웨이포인트로 이동할 때 내비게이션 컨트롤러가 웨이포인트를 향해 진행하면서 목표 ALT의 다양한 램프를 공급하여 해당 웨이포인트의 새로운 고도에 도달합니다. , 이전 경유지와 다른 경우.
메모
지상 초기화 중에 EKF에서 원점 위치를 설정하기 전에 GPS ASL 고도가 표시되는 경우가 있습니다.
아래쪽을 향한 RangeFinder가 활성화되고 범위 내에 있는 경우 Target ALT는 Copter 및 Plane의 VTOL 모드에서 RF의 고도 측정을 사용하도록 수정됩니다.
예를 들어, Copter의 ALTHOLD에 있고 RangeFinder의 범위를 벗어나 30m에서 호버링하고 있습니다. Target ALT는 현재 예상 ALT로 설정되었으며 이를 유지하려고 합니다. 이제 스로틀 스틱을 사용하여 10m까지 하강하고 이제 RF 범위 내에 있습니다. 스틱을 놓으면 Target ALT가 RF 보고 고도로 설정됩니다. 예상 고도는 여전히 제어 출력을 조정하는 데 사용되고 있습니다.
차량이 1m 높이의 지상 물체 위로 이동하는 경우. 예상 ALT는 BARO, GPS ALT 등을 기반으로 하기 때문에 변경되지 않지만 목표 ALT는 지상까지의 거리가 1m 더 적은 RF 판독값으로 인해 1M 증가합니다. RF 고도의 모든 변경 사항은 Target ALT에 즉시 반영되므로 덜 정확한 Estimated ALT가 약간 잘못 변경되는 경우 RF는 Target ALT 조정을 통해 이를 즉시 효과적으로 취소하여 보다 정확한 고도 제어를 제공합니다.
이것은 ArduPilot에서 호출됩니다.Surface Tracking
선택적으로(일반적으로 실내용으로만 권장됨) 고도 추정을 위해 RF를 EKF의 추가 센서 소스로 사용할 수 있습니다. 이것은 일반적으로 사용 가능한 유일한 고도 센서가 RF인 경우에만 사용됩니다. 범위가 매우 제한되어 있고 정확도에 대한 환경적 영향을 더 많이 받기 때문입니다.
이 활성화된 경우 GCS 또는 SD 카드의 지형 데이터 및/또는 활성화된 경우 거리계 범위 내에서 지상 거리의 RangeFinder 고도 판독값으로 수정할 수도 있습니다 . 두 경우 모두 EKF가 작동하는 한 GCS HUD 또는 OSD에 표시된 고도는 예상 고도입니다(그렇지 않으면 HOME에 상대적인 BARO 고도를 사용함).
RF의 측정값이 너무 빠르게 변경되거나(3개의 보고에 대해 >2m) RF가 범위를 벗어나면 무시되고 예상 ALT의 현재 고도가 새로운 목표 ALT로 설정됩니다. 이것은 빠르게 움직이는 RF 데이터로 급격한 상승/하강을 방지합니다. 또한 키가 큰 물체에 빠르게 접근하는 것과 같이 크고 빠른 변화가 필요한 추적은 영향을 미칠 수 있음을 의미합니다. 이러한 경우 참조하십시오 .
평면에서 고정 날개 모드를 사용할 때 RangeFinder 사용은 범위 내에 있고 매개변수에 의해 활성화된 경우 다음으로 제한됩니다.
착륙의 접근 및 플레어 전 단계에서 중 활공 경사를 조정합니다 .
하향 RF가 활성화되고 범위 내에 있는 경우 또는 에 도달할 때 고도를 결정합니다 .
에 Q_LAND_FINAL_ALT에 도달 하면 하향 RF가 활성화된 경우 QuadPlane의 VTOL 랜딩에 도달합니다.
미만인지 확인 중입니다 .
미만인지 확인합니다 .
Terrain Follow(지형 추적)가 활성화되고 활성화된 경우 차량 및 모드에 따라 이동할 때 현재 위치가 무엇이든 대상 ALT를 높이거나 낮추기 위해 지형 고도 변경이 사용됩니다. 자세한 내용은 평면에 대한 또는 Copter에 대한
Copter의 경우 저고도에서 장애물 너머의 얻기 위해 RangeFinder 사용과 결합할 수 있습니다 .
