경로 계획과 제어 알고리즘
검증한 지형에서 경로를 승인하고 추진 명령으로 바꿉니다. Gazebo의 실측 운동을 다음 계획·제어 판단에 되먹임합니다.
개인 수중 경유점 계획에는 임무 수심 제한을 적용합니다. 더 넓은 시뮬레이션 한계에서도 아래의 지형·선체 이동 범위 검사는 유지됩니다.
처리 흐름
- 1. 목표 + 실측 상태 + 지형
지리 목표를 현재 지역 좌표계로 바꿉니다. 확인한 타일을 공통 격자로 연결하고 누락된 범위는 미확인으로 남깁니다.
- 2. 지리·해안 경로 유도
육지를 피하는 경로와 항구 접근 통로를 찾습니다. 지도상 육지를 피했다는 사실만으로 여유 수심을 승인하지는 않습니다.
- 3. 선체 이동 범위 검사
선체에 추종 오차 여유를 더합니다. 바닥 삼각형을 검사 정사각형으로 잘라 최고 고도를 구하고, 육지·부족한 수심·결측을 거부합니다. 깊은 바다에서는 최대 필터의 보수적 경계로 검사를 빠르게 합니다.
- 4. 직선 검사 → A* 우회 탐색
검증한 직선을 먼저 시도합니다. 실패하면 8방향 격자에서 거리 비용과 유클리드 거리 휴리스틱으로 탐색하며 모서리 통과·반경·거리·시간 한계를 적용합니다.
- 5. 단축하고 다시 검증
같은 선체 범위 검사로 승인한 지름길만 적용하고 보호된 항구 접근점은 유지합니다. 경유점과 최소 여유 수심을 기록하며 안전한 경로가 없으면 오류를 반환합니다.
- 6. 속도 정책 → 추진 명령
자동 항해 선행 차량은 굽이·방향 오차에 따라 감속한 뒤 램프·PI 속도 제어와 차등 요 추력을 사용합니다. 추종 차량은 선행 차량의 실측 항적을 앞서 보며 기울기·접근 속도로 명령을 제한합니다.
- 7. 실측 피드백 → 다음 갱신
Gazebo가 힘을 적용해 운동을 계산합니다. 진행·안정성·지형 및 센서 범위를 확인하고 미확인 범위 앞에서 멈춥니다. 목표나 조건이 바뀌면 다시 계획할 수 있습니다.
LIVE 항해는 지도상 해안 연결 경로를 임시 유도로 사용합니다. 실측 위치가 연결 경로의 마지막 기준점보다 항로 목표에 50 m 이상 가까워지면 해당 유도를 해제하고 후속 경로를 다시 계획합니다. 새 추진 통로는 지도상 육지 제외와 수치 수심 검사를 계속 통과해야 합니다.
경로 계획 기술 목록
| 계층 | 방법과 자료 | 적용 범위 |
|---|---|---|
| 지리 경로 | 항만·도착 목표, 통과 지점과 육지 폴리곤으로 장거리 안내와 연안 연결 경로를 만듭니다. | 육지 회피만으로 수심 여유가 확인되지는 않습니다. 항만 목록 좌표와 항행 가능한 도착 목표는 별개입니다. |
| 지형장 | 확인된 수치 격자를 같은 좌표계로 결합합니다. 삼각형을 정확히 잘라 검사 사각형 안의 가장 높은 바닥을 찾고, 충분히 깊은 곳은 SciPy 최대 필터 상한으로 빠르게 확인합니다. | 알 수 없거나 범위 밖인 지형은 사용 불가로 남깁니다. 위성 색상을 수심으로 쓰지 않습니다. |
| 이동 경로의 여유 | 선분을 최대 1 m 간격으로 검사하며 검사 면적을 그 간격의 절반만큼 넓힙니다. 깊이가 변하는 구간은 더 깊은 끝점을 기준으로 합니다. | 보수적인 지형 포락 검사이며 미래의 6자유도 선체 운동 전체를 예측하는 것은 아닙니다. |
| 지역 탐색 | 직선 구간을 먼저 검사한 뒤 거리 비용·유클리드 휴리스틱·보수적 모서리 검사를 사용하는 8방향 A*를 수행합니다. 단축 구간도 같은 검사를 통과해야 합니다. | 기본 격자 간격 4 m, 탐색 반경 600 m, 경로 길이 2,000 m, 계산 시간 25초이며 호출자가 다른 한도를 선택할 수 있습니다. |
| 기체 여유 | 수상: 선체 반경 3.5 m, 초기 추종 여유 4 m, 바닥 여유 1.5 m입니다. 수중: 반경 0.5 m, 추종 여유 2 m, 바닥 여유 1 m입니다. | 개인 WAM-V의 재탐색은 추종 여유를 2 m로 줄일 수 있지만 수심 여유는 유지합니다. 계획 여유이며 수로 측량 정확도 보증이 아닙니다. |
| 결과·감시 | 검사한 경유점, 선택 여유, 격자·계산 한도와 표현된 최소 바닥 여유를 반환합니다. 실행 중 경로 이탈·범위 검사가 운항을 중단할 수 있습니다. | 계획 실패, 추종 이탈과 지형 부족은 별도 상태입니다. 경로가 있다고 선택한 환경에서 제어 성공이 보장되지는 않습니다. |
지역 계획기는 지형을 기준으로 합니다. AIS 표시, 영상 속 다른 선박이나 LiDAR 토픽이 있다는 사실만으로 이동 장애물 회피나 COLREG 준수를 의미하지 않습니다. 그런 동작은 실험에서 선택한 제어기에 속합니다.
LIVE 현장 해안 경로 복구
WWW-POSIM은 현재 불러온 수치 지형과 지도상 육지 제외 영역으로 경로를 찾습니다. 탐색 단계부터 일반 해안 거리 1.5 km를 적용합니다. 이 범위에서 검사한 후속 통로를 찾지 못하면 잠시 해안에서 최대 2 km까지 우회한 뒤, 끝점에서 일반 범위로 돌아오는 경로를 찾습니다.
끝점은 후속 목표 방향으로 최소 500 m 전진해야 하며, 목표까지 5 km 이내이면 남은 거리의 10%를 적용합니다. 얕은 수역 제외 범위 200 m와 지형상 최소 수심 2 m를 유지하며, 전체 통로 길이는 최대 12 km입니다. 네이티브 실행 단계에서 짧게 나눈 구간을 다시 검사합니다.
해안에서 항로 굽이를 건너뛸 때는 다음 항로 방향을 먼저 검사합니다. 그 방향에 안전한 통로가 없으면 같은 60초 탐색 예산 안에서 원래 항로 경유점 방향으로 다시 탐색합니다. 이미 확정한 탈출 목표는 유지합니다. 수역 탈출을 위한 국소 이동만으로 항해 진행 감시의 제한 시간을 갱신하지 않습니다.
새 복구 경로의 끝점은 최근 탈출한 영역 밖에 둡니다. 전체 안전 검사를 통과한 전진 통로는 그 영역을 가로질러 더 나아갈 수 있습니다. 후속 목표 방향으로 50 m 미만 전진하는 경로는 경로 전체에서 해당 영역을 피합니다. 이 이동 이력 조건은 실제 지형에 따른 선체 안전 판정에 영향을 주지 않습니다.
국소 복구만으로 곶을 돌아 전진할 수 없으면, 지도상 해안을 따라 연결한 경로의 굽이를 탐색 기준으로 유지합니다. 불러온 64 km 육지 창 안에서 OSM 제외 영역, 250 m 격자, 지도상 육지 여유 300 m와 일반 해안 범위 1.5 km를 사용합니다. 끝점은 원래 항로 목표까지의 거리를 최소 5 km 줄여야 하며, 목표가 가까우면 남은 거리의 10%를 적용합니다. 선택한 연결 경로는 국소 재탐색과 관리 프로세스 재시작 사이에도 유지합니다.
이 연결 경로는 탐색 방향을 제공하며 수심을 승인하지 않습니다. 실제 추진 구간은 현장 수치 지형과 네이티브 통로 검사를 계속 통과해야 합니다. 현재 통로가 승인된 동안에만 같은 연결 경로의 남은 길이로 진행을 판단합니다. 원을 그리는 이동이나 목표 교체로 진행 제한 시간을 갱신할 수 없습니다.
지역 복구를 반복해도 실측 진행이 10분간 없으면 LIVE는 16 km 지형 범위에서 항로 방향으로 이어지는 연결 경로를 탐색합니다. 선택한 굽이를 순서대로 따르며, 추진 전에 각 구간을 현재 네이티브 지형과 지도상 육지로 검사합니다.
정체 복구가 오래 지속되면 LIVE는 검사된 외해 통로를 이용할 수 있습니다. 이동이 재개되면 주기적으로 지도상 해안으로 복귀해 그 해안을 따라 전진할 경로를 찾습니다. 해안 탐색 창은 64 km이며 필요하면 128 km로 넓히지만, 수치 수심 검사 범위는 늘어나지 않습니다. 각 추진 구간에는 지도상 육지와 수치 수심 승인이 계속 필요합니다. 고정 항만 접근점은 필수이며 검사된 통로로 해당 진입점에 연결합니다.
제어 경로와 피드백
| 경로 | 입력 → 구현 → 구동 | 연구에서의 해석 |
|---|---|---|
| 개인 ArduPilot | 안내 목표·수동 입력 → MAVROS와 Gazebo JSON 인터페이스를 통한 ArduRover·ArduSub SITL → 설정된 구동기 채널입니다. | 항법 입력, EKF 상태, 모드, 시동과 구동기 매핑이 결과에 영향을 줍니다. GNSS와 항법에서 센서·참값·융합 추정값을 구분합니다. |
| ROS 2 직접 제어 | 사용자 ROS 노드 → 허용된 명령 토픽·구동기 매핑 → Gazebo 힘입니다. | 제어법은 사용자가 제공합니다. 목표·속도 명령의 발행과 실제 운동 측정은 다릅니다. |
| 자동 항해 선행 차량 | 검사한 경유점 → 굽힘 구간 감속, 방향 오차 속도 감소, 가속도 제한, 적분 제한 PI 속도 제어와 차동 방향 추력입니다. | 실제 기체 운동을 피드백합니다. 명목 제어 주기는 0.05초이며 하트비트가 끊기면 명령을 억제합니다. |
| 자동 항해 추종 차량 | 선행 차량의 측정 경로·거리·접근 속도 → 선행점 안내, 속도·회전 한도와 감속 → 추진입니다. | 명목 추종 간격은 선체 원점 사이 38 m입니다. 시연 제어기이며 선단 충돌 회피의 입증이 아닙니다. |
| 항해 복구 | 명시적 복구 정책은 질량·접촉·항력을 유지하면서 제한된 물리 견인을 요청할 수 있습니다. | 일반 자율 추진과 복구 모드를 구분해 기록하세요. 선행 차량 견인은 최대 900 N, 요청 복구 속도 0.8 m/s로 제한합니다. |
GNSS가 설정된 세션의 임무는 시동과 항법 안정화가 끝난 뒤 측정 위치에서 경로를 다시 검사하고 첫 목적지를 보냅니다. 안정화에는 최신 FCU 로컬 위치와 유효한 GNSS 융합 또는 수용된 외부 센서 항법 융합이 필요합니다. 수신기의 원시 GPS 고정 상태는 별도로 표시합니다. GNSS와 항법을 참고하세요.
개인 WAM-V 임무의 기본 설정은 입력 성형(GUID_OPTIONS=0)입니다. 방향을 따로 지정하지 않은 지점에서는 도착 반경 0.75 m 밖에서 원래 위치 목표를 시뮬레이션 시간 2초마다 갱신하고, 반경 안에서는 속도와 회전율을 0으로 요청합니다. 비트 64가 켜진 저장 프로필은 ArduRover의 S-curve 경유점 계획기를 유지합니다. BlueROV2는 ArduSub 경유점 제어기를 사용해 위치 목표를 시뮬레이션 시간 2초마다 갱신합니다. 텔레메트리 최신성은 실제 경과 시간으로 판단하며, 이동 중에도 항법과 지형 여유 검사를 계속합니다.
추진식 보트가 속도와 요율이 모두 0인 최신 Guided 목표를 받으면, 패키지의 ArduRover는 속도 PID를 계속 작동시켜 전후 방향의 표류를 억제합니다. 이 제어는 속도를 조절하며, 작성한 위치를 향한 보정은 도착 범위 밖에서 시작합니다. 범선, 유효 시간이 지난 목표와 다른 제어 모드는 각자의 정지 동작을 유지합니다.
가속도 제한을 적용한 목표 속도가 0이면 속도 제어기는 처음으로 정지를 측정했을 때 적분값을 초기화합니다. 설정된 정지 속도 범위 밖에서는 현재 표류 방향으로 선박을 가속할 적분값도 초기화합니다. 표류에 반대되는 제동 적분값과 정지 속도 범위 안의 보정값은 유지합니다.
개인 기본 프로필은 WP_SPEED=0.5 m/s, ATC_STOP_SPEED=0.02 m/s, ATC_STR_RAT_I=0을 사용합니다.
SITL 플러그인은 계산이 끝난 물리 상태 사이의 센서 값을 보간하며, 목표 주파수는 Rover 200 Hz, Sub 1000 Hz입니다. 물리 간격을 바꾸면 중간 샘플 수가 달라집니다. 각 구간은 원래 물리 상태와 시각에서 끝나며, 물리적 해상도는 물리 계산 간격에 따라 결정됩니다.
공개 WAM-V 데모는 입력 성형 방식(GUID_OPTIONS=0)을 선택하고 시뮬레이션 시간으로 2초마다 원래 경유점을 갱신합니다. 접근과 파도 속 정점 유지에는 WP_RADIUS=0.2 m, LOIT_RADIUS=0.1 m, LOIT_SPEED_GAIN=1.0을 사용합니다. 임무 도착은 계속 수평 오차 0.75 m 이내를 요구합니다. 개인 작업공간은 선택한 제어기 파라미터를 유지합니다.
체크포인트 복원과 좌표 원점 이동도 상태·좌표 명령을 사용합니다. 원점 이동은 측정 속도를 유지하면서 지형·경로·궤적 좌표를 변환하므로 물리 이동처럼 미분하면 안 됩니다. 추종 오차나 에너지 소모를 평가할 때 복구·초기화·원점 이동 이벤트를 함께 보관하세요.
구현: POSIM-Routing, POSIM-Control 네이티브 제어기. 세션 조율, 제어기 선택과 개인 임무의 제한 검사는 WWW-POSIM이 담당합니다.
읽을 때 알아둘 점
네이티브 선행·추종 알고리즘은 자동 세계 항해에 사용합니다. 개인 ArduPilot·ROS 2 직접 제어는 선택한 명령 경로를 사용합니다. 경로 승인은 표현된 지형과 차량 설정에 한정됩니다.
개인 WAM-V 경유점 임무는 선체 반경 3.5 m에 추종 여유 4 m를 더합니다. 이 여유 폭으로 출발점이나 통로를 승인할 수 없으면 추종 여유 2 m로 다시 계획합니다. 여유 수심 1.5 m는 계속 필요합니다. 실행 중 선택한 추종 통로를 벗어나면 임무를 중단합니다.
관련 문서와 구현
LIVE 세계 항해 · 설치형 작업공간에서 제어 · 지형 생성 과정과 알고리즘
POSIM-Routing: navigation.py, planning.py, 해안·항구 모듈. POSIM-Control: native/Pilot.cc, native/Follower.cc, Python 속도·안정성 정책. 앱이 지정한 커밋을 기준으로 확인하세요.