LAB 04 · 로봇 카페

바리스타 로봇 액션 만들기

내 PC에서 바리스타 로봇 액션 서버(/cafe/brew)를 켜고 로봄 연결기로 잇습니다. 카운터에서 메뉴와 잔 수를 골라 「주문」을 누르면 목표가 그대로 내 노드에 닿고, 내 노드가 단계마다 보내는 진행률이 「추출 중 · 2잔째 · 45%」처럼 뜨며, 끝나면 「아메리카노 2잔 완성 · 7.2초」가 뜹니다. 서비스가 한 번 묻고 답을 받는 통신이라면, 액션은 오래 걸리는 일을 맡기고 중간 소식과 취소까지 주고받는 통신입니다.

연결 순서

누가 무엇을 하나 카운터 단추 → 로봄 서버 → 연결기(액션 클라이언트) → /cafe/brew → 내 노드(액션 서버)

돌아오는 길 내 노드의 진행률(step · cups_done · percent)과 결과(cups_done · seconds) → 연결기 → 로봄 서버 → 카운터의 진행 줄 · 결과 줄

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

ros2 action list -t
ros2 node info /robom_cafe_sim
ros2 action send_goal /cafe/brew robom_interfaces/action/Brew "{menu: americano, cups: 2}" --feedback
  1. ROS 2 환경 확인

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

    source /opt/ros/jazzy/setup.bash
    printenv ROS_DISTRO

    이 실습실의 형식은 로봄 형식 패키지 robom_interfaces에 들어 있습니다. 내려받아 한 번만 빌드합니다.

    형식 패키지 내려받기 (robom_interfaces.tar.gz)

    판 1.0.0 · SHA-256 1630d68bff6b67a55c23226f7944cff52586ac11ebcb2c9bd2009c0ac88b1554

    mkdir -p ~/robom_ws/src && cd ~/robom_ws/src
    tar -xzf ~/Downloads/robom_interfaces.tar.gz
    cd ~/robom_ws && source /opt/ros/jazzy/setup.bash
    colcon build --packages-select robom_interfaces
    source ~/robom_ws/install/setup.bash
    ros2 interface show robom_interfaces/action/Brew

    마지막 형식이 보이면 끝입니다. source ~/robom_ws/install/setup.bash는 노드 터미널과 연결기 터미널 모두에서 합니다.

  2. 연결기 · 연습 노드 내려받기

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

    판 4 · SHA-256 5d4b39f350347fdff1770652a149b9f9549ddeae195802dcbe29c7a71a3eaa22

    이 실습실은 연결기 판 4 이상이어야 합니다. 받은 파일이 맞는지는 sha256sum robom_link.py로 견줘 봅니다.

    연습 바리스타 노드 내려받기 (robom_cafe_sim.py)

    판 2 · SHA-256 f616cab101801cc9c75b3ea67ca64d8cc05495606569aea3948171f265ece442

    내 액션 노드를 아직 못 짰으면 연습 바리스타 노드를 먼저 켭니다: python3 robom_cafe_sim.py. 짧고 주석이 많으니 고쳐 가며 배우세요. ROS 2 없이 네트워크만 먼저 볼 때는 연결기의 --demo를 씁니다(연습 모드라서 확인받기는 되지 않습니다).

  3. 연결 열쇠 받기

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

    로그인하고 열쇠 받기

  4. 파일 둘러보기

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

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

    1 · 한 장 그림

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

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

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

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

      /cafe/brew(액션)가 이 표에 있어야 연결기가 다룹니다.

      # ── 판 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 명령 받기 273번째 줄부터

      HTTP로 기다렸다가 서버가 보낸 주문 · 취소를 받아 ROS 2 쪽으로 넘깁니다.

      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)
    3. 3 서비스 · 액션 클라이언트 704번째 줄부터

      robom_interfaces가 있으면 /cafe/brew 액션 클라이언트를 미리 만듭니다.

      # 서비스 · 액션 클라이언트: 형식 패키지(robom_interfaces)가 있으면 미리 만든다
      self.clients, self.actions = {}, {}
      for name, type_name in SERVICES.items():
          if self._type(type_name) is not None:
              self.clients[name] = node.create_client(self._type(type_name), self.prefix + name)
      for name, type_name in ACTIONS.items():
          if self._type(type_name) is not None:
              self.actions[name] = action_client(node, self._type(type_name), self.prefix + name)
    4. 4 취소 넘기기 771번째 줄부터

      서버가 주문 취소를 보내면 내 노드에 취소 요청을 보냅니다.

      if kind == "action_cancel":
          if rid in self.goals:
              self.goals[rid].cancel_goal_async()
          else:
              self.cancel_later.add(rid)
          return
    5. 5 서비스 · 액션 부르기 857번째 줄부터

      주문으로 목표를 채워 보내고, 진행률이 올 때마다 서버로 올립니다.

      try:
          if kind == "service_call":
              future = self.clients[name].call_async(fill(type_.Request(), line["request"]))
              future.add_done_callback(lambda f: self._replied(rid, f.result()))
          else:
              future = self.actions[name].send_goal_async(
                  fill(type_.Goal(), line["goal"]),
                  feedback_callback=lambda f: self.link.report({"id": rid, "kind": "action_feedback", "feedback": plain(f.feedback)}),
              )
              future.add_done_callback(lambda f: self._accepted(rid, f.result()))
      except (TypeError, ValueError, AssertionError, AttributeError):
          self._fail(rid, "요청 값이 형식에 맞지 않습니다")
    6. 6 액션 결과 올리기 881번째 줄부터

      목표를 받아들였는지와, 끝났을 때 결과 · 끝난 모양(성공 · 취소)을 서버로 올립니다.

      def _accepted(self, rid: str, handle) -> None:
          statuses = {4: "succeeded", 5: "canceled", 6: "aborted"}  # action_msgs/msg/GoalStatus 값
          if handle is None or not handle.accepted:
              self._fail(rid, "학생 노드가 목표를 받지 않았습니다(거절)")
              return
          self.goals[rid] = handle
          self.link.report({"id": rid, "kind": "action_accepted"})
          if rid in self.cancel_later:
              handle.cancel_goal_async()
          handle.get_result_async().add_done_callback(
              lambda f: self.link.report(
                  {"id": rid, "kind": "action_result", "status": statuses.get(f.result().status, "aborted"), "result": plain(f.result().result)}
              )
          )

    3 · 연습 노드 읽기 robom_cafe_sim.py

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

    #!/usr/bin/env python3"""로봄 연습 바리스타 노드 — 로봇 카페 구역의 주문을 받아 만드는 바리스타 로봇. 뼈대는 되어 있고, 「# 할 일」을 채워 완성하는 노드다.쓰는 법 (Ubuntu 24.04 + ROS 2 Jazzy, 형식 패키지 robom_interfaces를 빌드해 둔 뒤):    source /opt/ros/jazzy/setup.bash    source ~/robom_ws/install/setup.bash    python3 robom_cafe_sim.py    # 다른 터미널에서도 같은 두 줄을 source하고 연결기를 켠다: python3 robom_link.py --key <연결 열쇠>이 바리스타 노드가 하는 일 (액션 서버):- /cafe/brew 액션(robom_interfaces/action/Brew)을 연다. 목표는 메뉴(menu: americano · latte)와 잔 수(cups: 1 ~ 3)다. (완성됨)- 목표를 받으면 메뉴의 단계를 잔마다 밟으며, 단계마다 진행률(step · cups_done · percent)을 보낸다. (「# 할 일」)- 다 만들면 결과(다 만든 잔 수 cups_done, 걸린 초 seconds)를 돌려준다. (「# 할 일」)- 「주문 취소」가 오면 받아들이고, 그때까지 다 만든 잔 수만 돌려주며 취소(canceled)로 끝낸다. (「# 할 일」)- --ns <이름>: 액션 이름 앞에 이름 공간을 붙인다(/<이름>/cafe/brew). 연결기의 --ns와 같은 이름을 쓴다.메뉴의 단계(잔마다): 아메리카노 = grind → extract → pour_water, 라떼 = grind → extract → steam_milk → pour. 단계 하나는 약 1초.그대로 켜면 주문은 받지만 곧바로 「0잔 완성」으로 끝나고 진행률도 취소도 없어서, 과제 셋 모두 한 줄로 떨어진다.파이썬 표준 라이브러리와 ROS 2에 들어 있는 rclpy, 그리고 내려받아 빌드한 robom_interfaces만 쓴다.이 파일을 고쳐 가며 배우세요. 「# 할 일」을 채운 뒤 노드를 다시 켜고 카운터에서 주문하면 진행 줄이 단계마다 바뀌는 것이 보입니다."""import argparseimport reimport sysimport timeVERSION = "2"STEP_SECONDS = 1.0  # 단계 하나에 걸리는 시간MENUS = {"americano": ("grind", "extract", "pour_water"), "latte": ("grind", "extract", "steam_milk", "pour")}def say(text: str) -> None:    print(text, flush=True)def make_node(namespace: str):    """바리스타 노드를 만든다. rclpy와 메시지 형식은 여기서만 불러온다."""    from rclpy.action import ActionServer, CancelResponse, GoalResponse    from rclpy.callback_groups import ReentrantCallbackGroup    from rclpy.node import Node    from robom_interfaces.action import Brew    name = f"/{namespace}/cafe/brew" if namespace else "/cafe/brew"

    액션 서버 열기 뼈대

    취소가 만드는 중에도 닿도록 콜백이 동시에 돌 수 있게 하고 /cafe/brew 액션 서버를 엽니다.

        class Barista(Node):        def __init__(self):            super().__init__("robom_cafe_sim")            # 취소가 실행 중에 닿으려면 콜백이 동시에 돌 수 있어야 한다(ReentrantCallbackGroup + MultiThreadedExecutor).            group = ReentrantCallbackGroup()            self.server = ActionServer(self, Brew, name, self.brew, goal_callback=self.on_goal, cancel_callback=self.on_cancel, callback_group=group)

    주문 받을지 정하기 뼈대

    아는 메뉴이고 잔 수가 1 ~ 3이면 주문을 받습니다.

            def on_goal(self, goal_request):            # 목표를 받을지 정한다. 아는 메뉴이고 잔 수가 1 ~ 3이면 받는다.            ok = goal_request.menu in MENUS and 1 <= goal_request.cups <= 3            say(f"주문 받음: {goal_request.menu} {goal_request.cups}잔" + ("" if ok else " → 받지 않음"))            return GoalResponse.ACCEPT if ok else GoalResponse.REJECT

    취소 받을지 정하기 내가 채움 과제 3 · 취소 받기

    주문 취소를 받을지 정하는 자리입니다.

            def on_cancel(self, goal_handle):            # 「주문 취소」를 받을지 정한다.            # 할 일: 지금은 취소를 늘 거절합니다. 받아들이는 답을 돌려주세요. 실제로 멈추는 일은 brew()의 단계마다 합니다과제 3 · 취소 받기            say("취소 요청 받음 → 거절")            return CancelResponse.REJECT

    만들기 내가 채움 과제 1 · 주문대로 만들기, 과제 2 · 진행률 보내기, 과제 3 · 취소 받기

    실행 콜백으로, 메뉴의 단계를 잔마다 밟으며 진행률을 보내고 끝나면 결과를 돌려주는 자리입니다.

            def brew(self, goal_handle):            # 실행 콜백: 목표(goal_handle.request.menu · cups)를 읽고 만든다. 연결기는 서버가 보낸 주문을 이 액션에 넘기고,            # 여기서 보내는 진행률과 결과를 서버로 보낸다.            menu, cups = goal_handle.request.menu, goal_handle.request.cups            steps = MENUS[menu]            started = time.monotonic()            # 할 일: 메뉴의 단계마다 feedback을 보내세요(잔마다 steps를 밟고, 단계를 마칠 때마다 지금 단계 · 다 만든 잔 수 ·과제 1 · 주문대로 만들기, 과제 2 · 진행률 보내기, 과제 3 · 취소 받기            #        전체 진행률을 담아 보냅니다. 단계마다 취소가 요청됐는지 보고, 요청됐으면 그때까지 만든 잔 수로 취소로 끝냅니다)            result = Brew.Result()            result.cups_done = 0  # 할 일: 다 만든 잔 수를 넣으세요과제 1 · 주문대로 만들기            result.seconds = float(time.monotonic() - started)            goal_handle.succeed()  # 성공으로 끝낸다            say(f"{menu} {result.cups_done}잔 완성 · {result.seconds:.1f}초 (단계 {len(steps)}개 × {cups}잔을 밟지 않았습니다)")            return result
        return Barista()

    노드 돌리기 뼈대

    여러 콜백을 동시에 돌리는 실행기로 노드를 돌리고, 끌 때 정리합니다.

    def run(namespace: str) -> None:    import rclpy    from rclpy.executors import MultiThreadedExecutor    rclpy.init()    node = make_node(namespace)    executor = MultiThreadedExecutor()    executor.add_node(node)    say(f"로봄 연습 바리스타 노드 판 {VERSION} · 액션 /cafe/brew(robom_interfaces/action/Brew)를 엽니다")    try:        executor.spin()  # 목표가 올 때마다 on_goal() → brew(), 취소가 오면 on_cancel()이 불린다    except KeyboardInterrupt:        say("연습 바리스타 노드를 끕니다")    finally:        node.destroy_node()        if rclpy.ok():            rclpy.shutdown()
    def main(argv=None) -> int:    parser = argparse.ArgumentParser(prog="robom_cafe_sim.py", description="로봄 연습 바리스타 노드 판 " + VERSION)    parser.add_argument("--ns", default="", help="액션 이름 공간(예: cafe1 → /cafe1/cafe/brew)")    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:        run(args.ns)    except ImportError:        say("ROS 2(rclpy)나 robom_interfaces를 찾지 못했습니다. source /opt/ros/jazzy/setup.bash와 "            "source ~/robom_ws/install/setup.bash를 먼저 했는지 보세요")        return 2    return 0if __name__ == "__main__":    sys.exit(main())

    지도로 가기

  5. 연결기 켜기

    연결기 파일이 있는 폴더에서 실행합니다. 「연결됨」이 뜨면 카운터의 「주문」을 누를 수 있습니다.

로봇 카페 카운터

연결 안 됨
메뉴
0%

로그인하면 주문할 수 있습니다

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

「주문」을 누르면 내가 고른 메뉴 · 잔 수를 서버가 그대로 목표({menu, cups})로 연결기에 보내고, 연결기가 내 PC의 /cafe/brew에 넘깁니다. 목표 수락은 5초 안에 와야 하고, 받은 뒤에는 오래 걸려도 됩니다.

판정은 확인 주문으로 합니다. 메뉴와 잔 수는 서버가 섞어 고릅니다.

과제 칸

통과 0/3

세 과제는 적는 답이 없습니다. 서버가 고른 확인 주문에 대해 내 연결 열쇠로 받은 액션 진행률 · 결과만 보고 판정합니다. 줄마다 지금 무엇이 모자란지 보이고, 조건이 맞으면 「확인받기」로 확인 번호를 받습니다.

과제 1 · 주문대로 만들기

로봇 카페에 바리스타 로봇이 새로 왔습니다. 주민이 고른 메뉴와 잔 수를 목표로 받아, 끝까지 만들고 몇 잔을 만들었는지 돌려줘야 합니다.

내 PC에서 /cafe/brew 액션 서버(robom_interfaces/action/Brew)를 켜고 연결기를 켜세요. 카운터에서 메뉴와 잔 수를 골라 「주문」으로 먼저 해 봅니다. 판정은 「확인 주문」으로 합니다. 서버가 메뉴와 잔 수를 섞어 골라 보내고, 결과의 cups_done이 주문한 잔 수와 같고 성공(succeeded)으로 끝나야 맞습니다. 잔 수가 다른 확인 주문 둘이 맞으면 「확인받기」로 통과합니다. 최근 확인 주문 셋 안에 틀린 것이 있으면 통과하지 않습니다.

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

힌트 보기
  • 연습 바리스타 노드(robom_cafe_sim.py)를 먼저 켜고, 다른 터미널에서 연결기를 켭니다. 두 터미널 모두 ROS 2와 robom_interfaces를 source합니다.
  • 목표의 menu와 cups를 읽고, 잔마다 메뉴의 단계를 다 밟은 뒤 다 만든 잔 수를 결과에 넣어 성공으로 끝냅니다.
  • 단계를 밟지 않고 곧바로 끝내면 만든 것으로 보지 않습니다.

과제 2 · 진행률 보내기

주민이 커피가 얼마나 됐는지 궁금해합니다. 바리스타 로봇은 단계마다 지금 무엇을 하는지, 몇 잔째인지, 얼마나 됐는지 알립니다.

주문을 만드는 동안 단계마다 진행률(step · cups_done · percent)을 보내세요. 아메리카노는 잔마다 grind → extract → pour_water, 라떼는 grind → extract → steam_milk → pour입니다. 「확인 주문」의 진행률에서 step이 그 메뉴 순서대로 잔마다 되풀이되고, percent가 줄지 않으며 마지막이 100이어야 맞습니다. 아메리카노와 라떼 확인 주문이 하나씩 맞으면 「확인받기」로 통과합니다. 최근 확인 주문 셋 안에 틀린 것이 있으면 통과하지 않습니다.

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

힌트 보기
  • 실행 콜백 안에서 단계 하나를 마칠 때마다 진행률 메시지(지금 단계 · 다 만든 잔 수 · 전체 퍼센트)를 채워 주문한 쪽에 보냅니다.
  • percent는 지금까지 마친 단계 수를 전체 단계 수(메뉴의 단계 수 × 잔 수)로 나눠 셈합니다.
  • ros2 action send_goal /cafe/brew robom_interfaces/action/Brew "{menu: latte, cups: 2}" --feedback 으로 내 노드의 진행률을 직접 볼 수 있습니다.

과제 3 · 취소 받기

주민이 마음을 바꿨습니다. 「주문 취소」를 받으면 바리스타 로봇이 바로 멈추고, 그때까지 다 만든 잔만 내줘야 합니다.

「취소 확인 주문」을 누르면 서버가 2 ~ 3잔 주문을 보내고, 진행률이 1잔이나 2잔(서버가 섞어 정함)을 다 만들었다고 알리면 취소를 보냅니다. 학생 노드가 취소를 받아 멈추고 취소(canceled)로 끝내며, 결과의 cups_done이 그때까지 다 만든 잔 수(진행률이 마지막으로 알린 잔 수)이면 맞습니다. 1잔 뒤 · 2잔 뒤 취소가 모두 맞으면 「확인받기」로 통과합니다. 최근 취소 확인 주문 셋 안에 틀린 것이 있으면 통과하지 않습니다.

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

힌트 보기
  • 액션 서버를 만들 때 cancel_callback이 취소를 받아들이게 합니다.
  • 실행 콜백의 단계마다 취소가 요청됐는지 보고, 요청됐으면 취소로 끝내며 그때까지 다 만든 잔 수를 결과로 돌려줍니다.