LAB 02 · 하늘 배달

내 드론을 이 도시에 띄우기

내 PC에서 도는 ROS 2 드론을 로봄 연결기로 하늘 배달 지도에 띄웁니다. 드론이 /drone/pose · /drone/battery로 보내는 값이 지도에 나타나고, 지도에서 누른 「출발 · 멈춤」은 내 PC의 /drone/command 토픽으로 들어갑니다.

연결 순서

누가 무엇을 하나 지도의 「출발 · 멈춤」 → 로봄 서버 → 연결기(퍼블리셔) → /drone/command → 내 노드(구독자)

돌아오는 길 내 노드(퍼블리셔) → /drone/pose · /drone/battery → 연결기(구독자) → 로봄 서버 → 지도의 내 드론 · 과제 줄

내 PC에서 직접 확인하는 명령(노드와 연결기가 켜진 뒤):

ros2 topic echo /drone/pose
ros2 topic info -v /drone/command
ros2 node info /robom_drone_sim
  1. ROS 2 환경 확인

    Ubuntu 24.04 + ROS 2 Jazzy가 필요합니다. 윈도우는 WSL의 Ubuntu에서 합니다. 터미널에서 아래를 차례로 쳐서 jazzy가 나오면 됩니다.

    source /opt/ros/jazzy/setup.bash
    printenv ROS_DISTRO
  2. 연결기 내려받기

    로봄 연결기 내려받기 (robom_link.py)

    판 4 · SHA-256 5d4b39f350347fdff1770652a149b9f9549ddeae195802dcbe29c7a71a3eaa22

    받은 파일이 맞는지는 sha256sum robom_link.py로 견줘 봅니다.

    연습 드론 노드 내려받기 (robom_drone_sim.py)

    판 2 · SHA-256 a9c10a5f4cc2615bfe228bfcff7ee664d8ae0f1c3e48cda165e44241b62bbc42

    드론이 없으면 연습 드론 노드를 먼저 켭니다: python3 robom_drone_sim.py. 연습 노드는 뼈대는 되어 있고 「# 할 일」을 채워 완성하는 노드입니다. 그대로 켜면 창고에 서 있기만 하고, frame_id도 지도 좌표가 아닙니다. ROS 2 없이 네트워크만 먼저 볼 때는 연결기의 --demo를 씁니다(연습 모드라서 확인받기는 되지 않습니다). 가짜 드론은 명령을 듣지 않고 창고와 도착지 사이를 오가기만 합니다.

  3. 연결 열쇠 받기

    열쇠는 로그인한 학생만 받습니다.

    로그인하고 열쇠 받기

  4. 파일 둘러보기

    켜기 전에 내려받은 두 파일이 무엇을 하는지 봅니다. 그림의 화살표를 누르면 그 일을 하는 코드가 아래에서 밝아집니다.

    연결기와 연습 노드 둘러보기

    1 · 한 장 그림

    내 PC
    내 노드robom_drone_sim.py
    연결기robom_link.py
    로봄 사이트
    로봄 서버열쇠 · 판정
    지도이 화면

    2 · 연결기 둘러보기 robom_link.py

    연결기는 이 실습실에서 아래 5곳을 씁니다. 내 PC의 ROS 2 쪽에서는 퍼블리셔 · 구독자 · 서비스 · 액션 · 파라미터 클라이언트 노릇을, 사이트 쪽에서는 HTTP로 묻고 올리는 노릇을 합니다.

    1. 1 허용 목록 52번째 줄부터

      드론 토픽 /drone/pose · /drone/battery · /drone/command가 이 표에 있어야 연결기가 다룹니다.

      # ── 판 4 허용 목록 (바로잡기 명세 1-2절) ── 서버(app/link/state.py)의 목록과 같아야 한다. 목록 밖은 연결기가 거절한다.
      INTERFACES = "robom_interfaces"
      SERVICES = {"/shuttle/arrival": "robom_interfaces/srv/ShuttleEta"}  # 셔틀 정류장
      ACTIONS = {"/cafe/brew": "robom_interfaces/action/Brew"}  # 바리스타 로봇
      PUBLISH_TOPICS = {  # 사이트가 보내 달라고 할 수 있는 토픽
          "/crossroad/signal": "std_msgs/msg/String",
          "/farm/moisture": "std_msgs/msg/Float64",
      }
      REPEAT_TOPICS = ("/crossroad/signal",)  # 다음 값이 올 때까지 같은 값을 다시 보낸다(교차로가 신호를 계속 방송하는 장면)
      REPEAT_EVERY = 0.5
      WATCH_TOPICS = {  # 켜질 때 모두 구독해 두고, 받은 것을 1초에 한 번 모아 올린다
          "/shuttle/position": "std_msgs/msg/Float64",
          "/crossroad/cmd_vel": "geometry_msgs/msg/Twist",
          "/energy/robot_status": "std_msgs/msg/Header",
          "/farm/water": "std_msgs/msg/Bool",
      }
      PARAM_NODES = ("/robom_farm",)  # 파라미터를 읽고 바꿀 수 있는 노드
      DRONE_TOPICS = {  # 드론(3차부터 그대로)
          "/drone/pose": "geometry_msgs/msg/PoseStamped",
          "/drone/battery": "sensor_msgs/msg/BatteryState",
          "/drone/command": "std_msgs/msg/String",
      }
    2. 2 올리기 줄기 247번째 줄부터

      넣어 둔 마지막 위치 · 배터리를 1초에 5번 HTTP로 서버에 올리고, 처음 닿으면 「연결됨」을 찍습니다.

      def send_loop(self) -> None:
          connected, tries = False, 0
          while not self.stop.is_set():
              payload = self._take()
              if payload is not None:
                  try:
                      self.server.send(payload)
                      if not connected:
                          say(f"연결됨 · {self.server.base}")
                          connected = True
                      tries = 0
                  except KeyExpired:
                      self._expired()
                      return
                  except ServerSaid as error:
                      say(error.args[0])
                      self.stop.wait(1.0 if error.status == 429 else 5.0)
                      continue
                  except (urllib.error.URLError, OSError):
                      connected = False
                      tries = self._retry(tries, "보내기")
                      continue
              self.stop.wait(1.0 / SEND_PER_SECOND)
    3. 3 명령 받기 273번째 줄부터

      HTTP로 기다렸다가 서버가 보낸 「출발 · 멈춤」을 받아 드론 쪽으로 넘깁니다.

      def command_loop(self) -> None:
          tries = 0
          while not self.stop.is_set():
              try:
                  commands = self.server.wait_commands()
                  tries = 0
              except KeyExpired:
                  self._expired()
                  return
              except ServerSaid as error:
                  say(error.args[0])
                  self.stop.wait(1.0)
                  continue
              except (urllib.error.URLError, OSError):
                  tries = self._retry(tries, "받기")
                  continue
              for line in commands:
                  if isinstance(line, str):  # 판 1 모양(서버가 판 머리를 못 본 때)
                      line = {"kind": "drone", "command": line}
                  if not isinstance(line, dict):
                      continue
                  kind = line.get("kind")
                  if kind == "drone" and line.get("command") in ("start", "stop"):
                      say(f"명령 받음: {line['command']}")
                      self.on_command(line["command"])
                  elif kind in REQUEST_KINDS and isinstance(line.get("id"), str):
                      what = line.get("name") or line.get("topic") or ""
                      say(f"요청 받음: {kind} {what}".rstrip())
                      self.on_request(line)
    4. 4 드론 토픽 677번째 줄부터

      내 노드의 /drone/pose · /drone/battery를 구독하고, 받은 명령을 /drone/command로 내보낼 퍼블리셔를 만듭니다.

      # 드론(3차부터 그대로). 받은 frame_id는 비어 있어도 그대로 올린다.
      string = self._need("std_msgs/msg/String")
      node.create_subscription(self._need(DRONE_TOPICS["/drone/pose"]), self.prefix + "/drone/pose", self.on_pose, 10)
      node.create_subscription(self._need(DRONE_TOPICS["/drone/battery"]), self.prefix + "/drone/battery", self.on_battery, 10)
      command = node.create_publisher(string, self.prefix + "/drone/command", 10)
      link.on_command = lambda text: command.publish(string(data=text))
    5. 5 위치 올리기 731번째 줄부터

      받은 위치(frame_id는 고치지 않고 64자까지)와 배터리를 마지막 값 하나로 넣어 둡니다.

      def on_pose(self, message) -> None:
          p, q = message.pose.position, message.pose.orientation
          self.link.update(
              pose={
                  "frame_id": str(message.header.frame_id)[:FRAME_MAX],
                  "position": {"x": p.x, "y": p.y, "z": p.z},
                  "orientation": {"x": q.x, "y": q.y, "z": q.z, "w": q.w},
              }
          )
      
      def on_battery(self, message) -> None:
          if math.isfinite(message.percentage):
              battery = {"percentage": min(1.0, max(0.0, message.percentage))}
              if math.isfinite(message.voltage) and message.voltage >= 0:
                  battery["voltage"] = message.voltage
              self.link.update(battery=battery)

    3 · 연습 노드 읽기 robom_drone_sim.py

    파일 전체입니다(표지 주석 줄만 뺐습니다). 그대로 두는 뼈대는 어두운 바탕, 내가 채우거나 고칠 줄(「# 할 일」 주석과 그 자리의 코드)은 노란 바탕이고, 「# 할 일」 옆에 그 과제 이름이 있습니다.

    #!/usr/bin/env python3"""로봄 연습 드론 노드 — 하늘 배달 드론. 뼈대는 되어 있고, 「# 할 일」을 채워 완성하는 노드다.쓰는 법 (Ubuntu 24.04 + ROS 2 Jazzy):    source /opt/ros/jazzy/setup.bash    python3 robom_drone_sim.py    # 다른 터미널에서 연결기를 켠다: python3 robom_link.py --key <연결 열쇠>이 드론 노드가 하는 일 (퍼블리셔 둘 · 구독자 하나):- /drone/pose(geometry_msgs/msg/PoseStamped)와 /drone/battery(sensor_msgs/msg/BatteryState)를 초당 5번 보낸다. (완성됨)- 위치의 header.frame_id는 지도 좌표의 이름이어야 한다. 지금은 odom이다. (「# 할 일」)- /drone/command(std_msgs/msg/String)를 받는다. start면 창고(12, 48)와 도착지(88, 14) 사이 배달 길을 오가며 날고(끝에 닿으면  돌아 나온다), stop이면 그 자리 그 높이에서 떠 있는다. 지금은 받은 글자를 찍기만 한다. (「# 할 일」)- --ns <이름>: 토픽 앞에 이름 공간을 붙인다(/<이름>/drone/pose). 연결기의 --ns와 같은 이름을 쓴다.지도 좌표는 ROS 2 map 좌표처럼 x는 오른쪽, y는 위로 커진다(가로 100 · 세로 60). 사이트 화면이 뒤집어 그린다.그대로 켜면 과제 1(연결하기)은 되지만, 과제 2 · 3은 「무엇이 안 됐는지」 한 줄로 떨어진다.파이썬 표준 라이브러리와 ROS 2에 들어 있는 rclpy만 쓴다(따로 설치할 것이 없다)."""import argparseimport reimport sysVERSION = "2"RATE = 5  # 초당 보내기 횟수DEPOT, DROPOFF = (12.0, 48.0), (88.0, 14.0)  # 창고 · 도착지(map 좌표)SPEED = 4.0  # 지도 단위/초ALTITUDE = 10.0

    지도 좌표 이름 내가 채움 과제 2 · 지도에 나타나기

    위치에 붙일 좌표계 이름으로, 지도 좌표로 보이려면 무엇이어야 할지 정하는 자리입니다.

    FRAME_ID = "odom"  # 할 일: 하늘 배달 지도의 좌표 이름으로 바꾸세요(과제 2)과제 2 · 지도에 나타나기
    DRAIN_FLYING = 0.001  # 날 때 초당 배터리 감소(0~1): 다 차 있으면 16분 남짓 난다DRAIN_HOVER = 0.0  # 서 있거나 떠 있을 때는 닳지 않는다(수업 내내 켜 두어도 날 수 있게)FULL_VOLTAGE = 12.6def say(text: str) -> None:    print(text, flush=True)class SimDrone:    """ROS 2와 상관없는 드론 상태. 처음에는 창고 바닥에 서 있다."""    def __init__(self):        self.x, self.y, self.z = DEPOT[0], DEPOT[1], 0.0        self.flying = False  # 배달 길을 날고 있는가        self.goal = DROPOFF  # 지금 날아가는 끝(닿으면 다른 끝으로 바꿔 돌아 나온다)        self.battery = 1.0

    명령 알아듣기 내가 채움 과제 3 · 명령이 닿기

    /drone/command로 받은 글자를 보고 드론 상태를 바꾸는 자리입니다.

        def command(self, command: str) -> bool:        """/drone/command로 받은 글자. 알아들은 명령이면 True."""        if command not in ("start", "stop"):            return False        # 할 일: start면 날기 시작하고(self.flying), stop이면 그 자리 그 높이에서 떠 있게 하세요과제 3 · 명령이 닿기        return True

    나는 걸음 내가 채움 과제 3 · 명령이 닿기

    타이머마다 불려, 날고 있을 때 드론을 어디로 얼마나 옮길지 정하는 자리입니다.

        def step(self, dt: float) -> None:        """타이머마다 dt초만큼 상태를 고친다."""        if self.flying and self.battery > 0:            pass  # 할 일: 날고 있으면 높이를 맞추고, 지금 자리에서 가는 끝(self.goal) 쪽으로 이번 주기에 갈 만큼 옮기세요. 끝에 닿으면 다른 끝으로 바꿔 돌아 나옵니다과제 3 · 명령이 닿기        drain = DRAIN_FLYING if self.flying else DRAIN_HOVER        self.battery = max(0.0, self.battery - drain * dt)
        def position(self) -> tuple[float, float, float]:        return self.x, self.y, self.zdef run(namespace: str) -> int:    # rclpy는 여기서만 불러온다.    import rclpy    from geometry_msgs.msg import PoseStamped    from rclpy.node import Node    from sensor_msgs.msg import BatteryState    from std_msgs.msg import String    prefix = f"/{namespace}/drone" if namespace else "/drone"    rclpy.init()    node = Node("robom_drone_sim")    drone = SimDrone()

    퍼블리셔 · 구독자 만들기 뼈대

    위치 · 배터리를 보낼 퍼블리셔와 명령을 받을 구독자를 만듭니다.

        pose_pub = node.create_publisher(PoseStamped, prefix + "/pose", 10)    battery_pub = node.create_publisher(BatteryState, prefix + "/battery", 10)    def on_command(message) -> None:  # 구독자 콜백: 연결기가 사이트의 「출발 · 멈춤」을 이 토픽으로 넘긴다        if drone.command(message.data):            say(f"명령 받음: {message.data}")    node.create_subscription(String, prefix + "/command", on_command, 10)

    위치 · 배터리 보내기 뼈대

    1초에 5번 위치(PoseStamped)와 배터리(BatteryState)를 채워 보냅니다.

        def tick() -> None:        drone.step(1.0 / RATE)        x, y, z = drone.position()        pose = PoseStamped()        pose.header.stamp = node.get_clock().now().to_msg()        pose.header.frame_id = FRAME_ID        pose.pose.position.x, pose.pose.position.y, pose.pose.position.z = float(x), float(y), float(z)        pose.pose.orientation.w = 1.0        pose_pub.publish(pose)        battery = BatteryState()        battery.header.stamp = pose.header.stamp        battery.percentage = float(drone.battery)        battery.voltage = float(FULL_VOLTAGE * (0.8 + 0.2 * drone.battery))        battery.present = True        battery_pub.publish(battery)    node.create_timer(1.0 / RATE, tick)
        say(f"로봄 연습 드론 노드 판 {VERSION} · 토픽 {prefix}/pose · {prefix}/battery 보냄 · {prefix}/command 받음")    say(f"지금은 창고({DEPOT[0]:.0f}, {DEPOT[1]:.0f})에 서 있습니다. 「# 할 일」을 채우면 「출발」에 배달 길을 오가며 납니다")

    노드 돌리기 뼈대

    노드를 돌려 타이머와 구독 콜백이 불리게 하고, 끌 때 정리합니다.

        try:        rclpy.spin(node)    except KeyboardInterrupt:        say("연습 드론 노드를 끕니다")    finally:        node.destroy_node()        if rclpy.ok():            rclpy.shutdown()
        return 0def main(argv=None) -> int:    parser = argparse.ArgumentParser(prog="robom_drone_sim.py", description="로봄 연습 드론 노드 판 " + VERSION)    parser.add_argument("--ns", default="", help="토픽 이름 공간(예: drone1 → /drone1/drone/pose)")    args = parser.parse_args(argv)    if args.ns and not re.fullmatch(r"[A-Za-z][A-Za-z0-9_]{0,31}", args.ns):        say("--ns는 영문자로 시작하는 32자 안의 영문 · 숫자 · _만 됩니다")        return 2    try:        return run(args.ns)    except ImportError:        say("ROS 2(rclpy)를 찾지 못했습니다. source /opt/ros/jazzy/setup.bash 를 먼저 하세요")        return 2if __name__ == "__main__":    sys.exit(main())

    지도로 가기

  5. 연결기 켜기

    연결기 파일이 있는 폴더에서 실행합니다. 「연결됨」이 뜨면 지도에 내 드론이 나타납니다.

하늘 배달 지도 · 내 드론

연결 안 됨
구름나래 배달 창고 (12, 48) 별빛마을 3동 (88, 14)
↓ 재난 대응 · 준비 중
내 드론 배터리 —

지도 좌표는 ROS 2의 map 좌표처럼 x는 오른쪽, y는 위로 커집니다. 화면은 그것을 위아래로 뒤집어 그립니다.

연결기가 붙으면 누를 수 있습니다.

「출발 · 멈춤」은 직접 해 보는 단추입니다. 과제 3은 「확인 비행」으로만 판정합니다: 서버가 「출발」을 보내고, 서버가 고른 때에 「멈춤」을 보내기를 네 번(망이 끊기면 그 차례를 다시) 합니다. 출발을 받고 1초 안에 배달 길을 따라 나아가고, 멈춤을 받고 1.5초 안에 서서 다음 출발까지 그 자리 그 높이를 지키세요(위치는 map, 한 번에 10 넘게 건너뛰지 않기).

동그라미는 첫 화면의 시연 드론, 마름모는 내 드론입니다. 내 드론은 나에게만 보입니다.

과제 칸

통과 0/3

세 과제는 적는 답이 없습니다. 서버가 내 연결 열쇠로 받은 메시지만 보고 판정합니다. 줄마다 지금 무엇이 모자란지 보이고, 조건이 맞으면 「확인받기」로 확인 번호를 받습니다.

과제 1 · 연결하기

하늘 배달 관제실이 새 드론을 받을 준비를 마쳤습니다. 먼저 내 드론의 위치가 관제실에 닿는지 확인합니다.

연결 열쇠로 연결기를 켜고, 드론 노드가 /drone/pose(PoseStamped)를 보내게 하세요. 서버가 내 열쇠로 형식이 맞는 위치를 하나라도 받으면 「확인받기」로 통과합니다.

로그인하고 연결 열쇠로 연결기를 켜면 서버가 받은 메시지로 판정합니다

힌트 보기
  • 연습 드론 노드(robom_drone_sim.py)를 먼저 켜고, 다른 터미널에서 연결기를 켭니다. 두 터미널 모두 source /opt/ros/jazzy/setup.bash를 먼저 합니다.
  • ros2 topic echo /drone/pose 로 위치가 나오는지 보면 연결기 앞쪽이 맞는지 알 수 있습니다.

과제 2 · 지도에 나타나기

관제실 지도에는 지도 좌표(map)로 온 위치만 그립니다. 내 드론이 지도 위에 머물러 있는지 확인합니다.

위치의 frame_id를 map으로, x는 0~100 · y는 0~60 안으로 보내세요. 지도 좌표는 ROS 2의 map처럼 x는 오른쪽, y는 위로 커집니다. 지도 안 위치를 3초 넘게 10개 이상 이어서 받으면 「확인받기」로 통과합니다.

로그인하고 연결 열쇠로 연결기를 켜면 서버가 받은 메시지로 판정합니다

힌트 보기
  • PoseStamped의 header.frame_id가 지도 좌표의 이름이어야 합니다. 연결기는 frame_id를 채우거나 고치지 않고 받은 그대로 올립니다.
  • ros2 topic echo /drone/pose 로 header.frame_id가 무엇으로 나가는지 먼저 보세요.
  • 위치가 2초 넘게 끊기면 처음부터 다시 셉니다. 연결기를 켜 둔 채 기다리세요.

과제 3 · 명령이 닿기

배달 드론은 창고와 별빛마을 3동 사이 배달 길을 오가며 납니다. 관제실이 「출발」을 보내면 길을 따라 날고(끝에 닿으면 돌아 나옵니다), 「멈춤」을 보내면 그 자리 그 높이에서 떠 있어야 합니다. 관제실이 정한 때에 보낸 명령을 내 노드가 듣고 따르는지 확인합니다.

연결된 상태에서 지도 아래 「확인 비행」을 누르세요. 서버가 /drone/command로 start와 stop을 네 번(망이 끊기면 그 차례를 다시) 보냅니다(stop과 다음 start를 보내는 때는 서버가 고릅니다). 네 번 모두 아래 넷을 지키면 그 확인 비행이 맞습니다. 1. start를 받고 1초 안에 배달 길을 따라 나아가기 시작합니다(start가 오기 전에는 그 자리에 떠 있습니다). 2. stop을 받기 직전까지 나아가다가, 받은 뒤 1.5초 안에 서서 그 자리 그 높이를 지킵니다. 3. 위치는 frame_id map으로 보냅니다. 4. 위치가 한 번에 10 넘게 건너뛰지 않습니다. 확인 비행이 세 번 이어서 맞으면 「확인받기」로 통과합니다. 망이 늦어 판정하지 못한 확인 비행은 그 사이에 한 번까지 세지 않고 건너뜁니다.

로그인하고 연결 열쇠로 연결기를 켜면 서버가 받은 메시지로 판정합니다

힌트 보기
  • ros2 topic echo /drone/command 로 start · stop이 내 PC에 닿는 때를 볼 수 있습니다.
  • 명령 콜백에서 받은 글자를 읽어 드론의 상태(날기 · 떠 있기)를 바꾸고, 위치를 보내는 타이머가 그 상태를 보고 위치를 고치게 하세요.
  • 날 때는 지금 자리에서 가는 끝(self.goal) 쪽으로 조금씩 옮기고, 끝에 닿으면 다른 끝으로 돌아 나옵니다. 떠 있을 때는 자리와 높이를 그대로 둡니다. 멈출 때를 정해 두지 말고 stop을 기다리세요.
  • 「출발 · 멈춤」 단추로 먼저 해 보세요. 드론이 길을 오가므로 노드를 다시 켤 일은 없습니다.