연결기는 이 실습실에서 아래 6곳을 씁니다. 내 PC의 ROS 2 쪽에서는 퍼블리셔 · 구독자 · 서비스 · 액션 · 파라미터 클라이언트 노릇을, 사이트 쪽에서는 HTTP로 묻고 올리는 노릇을 합니다.
-
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 명령 받기 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 서비스 · 액션 클라이언트 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 취소 넘기기 771번째 줄부터
서버가 주문 취소를 보내면 내 노드에 취소 요청을 보냅니다.
if kind == "action_cancel":
if rid in self.goals:
self.goals[rid].cancel_goal_async()
else:
self.cancel_later.add(rid)
return
-
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 액션 결과 올리기 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)}
)
)
파일 전체입니다(표지 주석 줄만 뺐습니다). 그대로 두는 뼈대는 어두운 바탕, 내가 채우거나 고칠 줄(「# 할 일」 주석과 그 자리의 코드)은 노란 바탕이고, 「# 할 일」 옆에 그 과제 이름이 있습니다.
1#!/usr/bin/env python32"""로봄 연습 바리스타 노드 — 로봇 카페 구역의 주문을 받아 만드는 바리스타 로봇. 뼈대는 되어 있고, 「# 할 일」을 채워 완성하는 노드다.34쓰는 법 (Ubuntu 24.04 + ROS 2 Jazzy, 형식 패키지 robom_interfaces를 빌드해 둔 뒤):5 source /opt/ros/jazzy/setup.bash6 source ~/robom_ws/install/setup.bash7 python3 robom_cafe_sim.py8 # 다른 터미널에서도 같은 두 줄을 source하고 연결기를 켠다: python3 robom_link.py --key <연결 열쇠>910이 바리스타 노드가 하는 일 (액션 서버):11- /cafe/brew 액션(robom_interfaces/action/Brew)을 연다. 목표는 메뉴(menu: americano · latte)와 잔 수(cups: 1 ~ 3)다. (완성됨)12- 목표를 받으면 메뉴의 단계를 잔마다 밟으며, 단계마다 진행률(step · cups_done · percent)을 보낸다. (「# 할 일」)13- 다 만들면 결과(다 만든 잔 수 cups_done, 걸린 초 seconds)를 돌려준다. (「# 할 일」)14- 「주문 취소」가 오면 받아들이고, 그때까지 다 만든 잔 수만 돌려주며 취소(canceled)로 끝낸다. (「# 할 일」)15- --ns <이름>: 액션 이름 앞에 이름 공간을 붙인다(/<이름>/cafe/brew). 연결기의 --ns와 같은 이름을 쓴다.1617메뉴의 단계(잔마다): 아메리카노 = grind → extract → pour_water, 라떼 = grind → extract → steam_milk → pour. 단계 하나는 약 1초.18그대로 켜면 주문은 받지만 곧바로 「0잔 완성」으로 끝나고 진행률도 취소도 없어서, 과제 셋 모두 한 줄로 떨어진다.19파이썬 표준 라이브러리와 ROS 2에 들어 있는 rclpy, 그리고 내려받아 빌드한 robom_interfaces만 쓴다.20이 파일을 고쳐 가며 배우세요. 「# 할 일」을 채운 뒤 노드를 다시 켜고 카운터에서 주문하면 진행 줄이 단계마다 바뀌는 것이 보입니다.21"""2223import argparse24import re25import sys26import time2728VERSION = "2"29STEP_SECONDS = 1.0 # 단계 하나에 걸리는 시간30MENUS = {"americano": ("grind", "extract", "pour_water"), "latte": ("grind", "extract", "steam_milk", "pour")}313233def say(text: str) -> None:34 print(text, flush=True)353637def make_node(namespace: str):38 """바리스타 노드를 만든다. rclpy와 메시지 형식은 여기서만 불러온다."""39 from rclpy.action import ActionServer, CancelResponse, GoalResponse40 from rclpy.callback_groups import ReentrantCallbackGroup41 from rclpy.node import Node42 from robom_interfaces.action import Brew4344 name = f"/{namespace}/cafe/brew" if namespace else "/cafe/brew"45
액션 서버 열기 뼈대
취소가 만드는 중에도 닿도록 콜백이 동시에 돌 수 있게 하고 /cafe/brew 액션 서버를 엽니다.
47 class Barista(Node):48 def __init__(self):49 super().__init__("robom_cafe_sim")50 # 취소가 실행 중에 닿으려면 콜백이 동시에 돌 수 있어야 한다(ReentrantCallbackGroup + MultiThreadedExecutor).51 group = ReentrantCallbackGroup()52 self.server = ActionServer(self, Brew, name, self.brew, goal_callback=self.on_goal, cancel_callback=self.on_cancel, callback_group=group)
주문 받을지 정하기 뼈대
아는 메뉴이고 잔 수가 1 ~ 3이면 주문을 받습니다.
56 def on_goal(self, goal_request):57 # 목표를 받을지 정한다. 아는 메뉴이고 잔 수가 1 ~ 3이면 받는다.58 ok = goal_request.menu in MENUS and 1 <= goal_request.cups <= 359 say(f"주문 받음: {goal_request.menu} {goal_request.cups}잔" + ("" if ok else " → 받지 않음"))60 return GoalResponse.ACCEPT if ok else GoalResponse.REJECT
취소 받을지 정하기 내가 채움 과제 3 · 취소 받기
주문 취소를 받을지 정하는 자리입니다.
64 def on_cancel(self, goal_handle):65 # 「주문 취소」를 받을지 정한다.66 # 할 일: 지금은 취소를 늘 거절합니다. 받아들이는 답을 돌려주세요. 실제로 멈추는 일은 brew()의 단계마다 합니다과제 3 · 취소 받기과제 3 · 취소 받기67 say("취소 요청 받음 → 거절")68 return CancelResponse.REJECT
만들기 내가 채움 과제 1 · 주문대로 만들기, 과제 2 · 진행률 보내기, 과제 3 · 취소 받기
실행 콜백으로, 메뉴의 단계를 잔마다 밟으며 진행률을 보내고 끝나면 결과를 돌려주는 자리입니다.
72 def brew(self, goal_handle):73 # 실행 콜백: 목표(goal_handle.request.menu · cups)를 읽고 만든다. 연결기는 서버가 보낸 주문을 이 액션에 넘기고,74 # 여기서 보내는 진행률과 결과를 서버로 보낸다.75 menu, cups = goal_handle.request.menu, goal_handle.request.cups76 steps = MENUS[menu]77 started = time.monotonic()78 # 할 일: 메뉴의 단계마다 feedback을 보내세요(잔마다 steps를 밟고, 단계를 마칠 때마다 지금 단계 · 다 만든 잔 수 ·과제 1 · 주문대로 만들기, 과제 2 · 진행률 보내기, 과제 3 · 취소 받기과제 1 · 2 · 379 # 전체 진행률을 담아 보냅니다. 단계마다 취소가 요청됐는지 보고, 요청됐으면 그때까지 만든 잔 수로 취소로 끝냅니다)80 result = Brew.Result()81 result.cups_done = 0 # 할 일: 다 만든 잔 수를 넣으세요과제 1 · 주문대로 만들기과제 1 · 주문대로 만들기82 result.seconds = float(time.monotonic() - started)83 goal_handle.succeed() # 성공으로 끝낸다84 say(f"{menu} {result.cups_done}잔 완성 · {result.seconds:.1f}초 (단계 {len(steps)}개 × {cups}잔을 밟지 않았습니다)")85 return result
8788 return Barista()8990
노드 돌리기 뼈대
여러 콜백을 동시에 돌리는 실행기로 노드를 돌리고, 끌 때 정리합니다.
92def run(namespace: str) -> None:93 import rclpy94 from rclpy.executors import MultiThreadedExecutor9596 rclpy.init()97 node = make_node(namespace)98 executor = MultiThreadedExecutor()99 executor.add_node(node)100 say(f"로봄 연습 바리스타 노드 판 {VERSION} · 액션 /cafe/brew(robom_interfaces/action/Brew)를 엽니다")101 try:102 executor.spin() # 목표가 올 때마다 on_goal() → brew(), 취소가 오면 on_cancel()이 불린다103 except KeyboardInterrupt:104 say("연습 바리스타 노드를 끕니다")105 finally:106 node.destroy_node()107 if rclpy.ok():108 rclpy.shutdown()
110111112def main(argv=None) -> int:113 parser = argparse.ArgumentParser(prog="robom_cafe_sim.py", description="로봄 연습 바리스타 노드 판 " + VERSION)114 parser.add_argument("--ns", default="", help="액션 이름 공간(예: cafe1 → /cafe1/cafe/brew)")115 args = parser.parse_args(argv)116 if args.ns and not re.fullmatch(r"[A-Za-z][A-Za-z0-9_]{0,31}", args.ns):117 say("--ns는 영문자로 시작하는 32자 안의 영문 · 숫자 · _만 됩니다")118 return 2119 try:120 run(args.ns)121 except ImportError:122 say("ROS 2(rclpy)나 robom_interfaces를 찾지 못했습니다. source /opt/ros/jazzy/setup.bash와 "123 "source ~/robom_ws/install/setup.bash를 먼저 했는지 보세요")124 return 2125 return 0126127128if __name__ == "__main__":129 sys.exit(main())