연결기는 이 실습실에서 아래 8곳을 씁니다. 내 PC의 ROS 2 쪽에서는 퍼블리셔 · 구독자 · 서비스 · 액션 · 파라미터 클라이언트 노릇을, 사이트 쪽에서는 HTTP로 묻고 올리는 노릇을 합니다.
-
1 허용 목록 52번째 줄부터
/shuttle/position(지켜보기)과 /shuttle/arrival(서비스)이 이 표에 있어야 연결기가 다룹니다.
# ── 판 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 지켜본 메시지 올리기 305번째 줄부터
구독해서 받은 셔틀 위치를 1초에 한 번 모아 서버로 올립니다.
def watch_loop(self) -> None:
"""지켜본 메시지를 WATCH_EVERY초에 한 번 모아 올린다(판 3). 받은 것이 없으면 보내지 않는다."""
tries = 0
while not self.stop.wait(WATCH_EVERY):
batch = self._take_watched()
if not batch:
continue
try:
self.server.report({"kind": "topic_watch", "messages": batch})
tries = 0
except KeyExpired:
self._expired()
return
except ServerSaid as error:
say(error.args[0])
if error.status == 429: # 속도 제한: 묶음을 되돌려 두고 다음 차례에 함께 보낸다(모양 오류는 버린다)
self._put_back(batch)
except (urllib.error.URLError, OSError):
tries = self._retry(tries, "지켜본 메시지 올리기")
-
4 지켜볼 토픽 구독 690번째 줄부터
켤 때 /shuttle/position을 구독해 둡니다.
for topic, type_name in WATCH_TOPICS.items():
node.create_subscription(self._need(type_name), self.prefix + topic, self._watcher(topic, type_name), 10)
-
5 서비스 · 액션 클라이언트 704번째 줄부터
robom_interfaces가 있으면 /shuttle/arrival 서비스 클라이언트를 미리 만듭니다.
# 서비스 · 액션 클라이언트: 형식 패키지(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)
-
6 받은 메시지 담기 750번째 줄부터
받은 위치 메시지를 칸 이름이 붙은 값으로 바꿔 올릴 묶음에 넣습니다.
def _watcher(self, topic: str, type_name: str):
def on_message(message) -> None:
data = to_plain(type_name, message)
if data is not None:
self.link.watch(topic, data)
return on_message
-
7 서비스 · 액션 부르기 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, "요청 값이 형식에 맞지 않습니다")
-
8 서비스 답 올리기 873번째 줄부터
내 노드가 돌려준 답(minutes)을 서버로 올립니다.
def _replied(self, rid: str, response) -> None:
if response is None:
self._fail(rid, "서비스 서버가 답을 주지 않았습니다. 내 노드의 터미널에 오류가 있는지 보세요")
else:
self.link.report({"id": rid, "kind": "service_reply", "response": plain(response)})
파일 전체입니다(표지 주석 줄만 뺐습니다). 그대로 두는 뼈대는 어두운 바탕, 내가 채우거나 고칠 줄(「# 할 일」 주석과 그 자리의 코드)은 노란 바탕이고, 「# 할 일」 옆에 그 과제 이름이 있습니다.
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_shuttle_sim.py8 # 다른 터미널에서도 같은 두 줄을 source하고 연결기를 켠다: python3 robom_link.py --key <연결 열쇠>910이 셔틀 노드가 하는 일 (한 노드가 두 역할):11- 퍼블리셔: 노선(한 바퀴 12칸, 1초에 1칸) 위의 자기 위치를 /shuttle/position(std_msgs/msg/Float64)으로 1초에 5번 보낸다. (완성됨)12- 서비스 서버: /shuttle/arrival(robom_interfaces/srv/ShuttleEta)을 열고, 「n번 정류장까지 몇 분?」(request.stop)에13 남은 분(response.minutes)으로 답한다. (서버를 여는 데까지는 완성됨, 계산은 「# 할 일」)14- --ns <이름>: 토픽 · 서비스 이름 앞에 이름 공간을 붙인다(/<이름>/shuttle/...). 연결기의 --ns와 같은 이름을 쓴다.1516정류장 1 · 2 · 3은 노선의 0 · 4 · 8칸째에 있다. 1칸 = 1분으로 본다.17그대로 켜면 과제 1(서비스로 답하기)은 통과하지만, 과제 2(셔틀 위치로 답하기)는 「셔틀 위치로 보면 n분입니다」 한 줄로 떨어진다.18파이썬 표준 라이브러리와 ROS 2에 들어 있는 rclpy · std_msgs, 그리고 내려받아 빌드한 robom_interfaces만 쓴다.19이 파일을 고쳐 가며 배우세요. 「# 할 일」을 채운 뒤 노드를 다시 켜고 같은 정류장을 두 번 물어 보면 답이 바뀌는 것이 보입니다.20"""2122import argparse23import re24import sys2526VERSION = "2"27LAP = 12.0 # 노선 한 바퀴 칸 수28SPEED = 1.0 # 1초에 가는 칸 수29SEND_PER_SECOND = 5 # 위치를 보내는 횟수(1초에)30STOPS = {1: 0.0, 2: 4.0, 3: 8.0} # 정류장 번호 → 노선의 몇 칸째313233def say(text: str) -> None:34 print(text, flush=True)353637def make_node(namespace: str):38 """셔틀 노드를 만든다. rclpy와 메시지 형식은 여기서만 불러온다."""39 from rclpy.node import Node40 from robom_interfaces.srv import ShuttleEta41 from std_msgs.msg import Float644243 prefix = f"/{namespace}" if namespace else ""44
셔틀 노드 만들기 뼈대
위치를 보낼 퍼블리셔, 1초에 5번 부를 타이머, /shuttle/arrival 서비스 서버를 만듭니다.
46 class Shuttle(Node):47 def __init__(self):48 super().__init__("robom_shuttle_sim")49 self.position = 0.0 # 지금 노선의 몇 칸째에 있나(0 이상 12 미만)50 self.publisher = self.create_publisher(Float64, prefix + "/shuttle/position", 10)51 self.create_timer(1.0 / SEND_PER_SECOND, self.drive)52 self.create_service(ShuttleEta, prefix + "/shuttle/arrival", self.arrival)
위치 보내기 뼈대
타이머마다 셔틀을 조금 움직이고 지금 노선 위치를 보냅니다.
56 def drive(self):57 # 타이머 콜백: 셔틀을 조금 움직이고 지금 위치를 보낸다. 연결기가 이 토픽을 구독해 지도에 셔틀을 그린다.58 self.position = (self.position + SPEED / SEND_PER_SECOND) % LAP59 message = Float64()60 message.data = self.position61 self.publisher.publish(message)
정류장 답하기 내가 채움 과제 2 · 셔틀 위치로 답하기
서비스 콜백으로, 요청의 정류장 번호를 읽고 셔틀 위치로 계산한 답을 채워 돌려주는 자리입니다.
65 def arrival(self, request, response):66 # 서비스 콜백: 요청(request.stop)을 읽고 답(response.minutes)을 채워 돌려준다.67 # 연결기는 로봄 서버가 보낸 요청을 이 서비스에 넘기고, 돌려준 답을 서버로 보낸다.68 stop = request.stop69 # 할 일: 셔틀이 지금 어디 있는지 보지 않습니다. self.position으로 계산하세요과제 2 · 셔틀 위치로 답하기과제 2 · 셔틀 위치로 답하기70 # (STOPS[stop]이 정류장 자리, 노선은 한 바퀴 LAP칸, 정류장이 셔틀 뒤에 있으면 한 바퀴를 돌아야 닿습니다)71 response.minutes = stop * 272 say(f"요청 받음: 정류장 {stop}번 → {response.minutes}분 뒤 도착 (셔틀은 {self.position:.1f}칸째)")73 return response
7576 return Shuttle()7778
노드 돌리기 뼈대
노드를 돌려 타이머와 서비스 콜백이 불리게 하고, 끌 때 정리합니다.
80def run(namespace: str) -> None:81 import rclpy8283 rclpy.init()84 node = make_node(namespace)85 say(f"로봄 연습 셔틀 노드 판 {VERSION} · /shuttle/position을 보내고 /shuttle/arrival(robom_interfaces/srv/ShuttleEta)에 답합니다")86 try:87 rclpy.spin(node) # 타이머마다 drive(), 요청이 올 때마다 arrival()이 불린다88 except KeyboardInterrupt:89 say("연습 셔틀 노드를 끕니다")90 finally:91 node.destroy_node()92 if rclpy.ok():93 rclpy.shutdown()
959697def main(argv=None) -> int:98 parser = argparse.ArgumentParser(prog="robom_shuttle_sim.py", description="로봄 연습 셔틀 노드 판 " + VERSION)99 parser.add_argument("--ns", default="", help="이름 공간(예: bus1 → /bus1/shuttle/arrival)")100 args = parser.parse_args(argv)101 if args.ns and not re.fullmatch(r"[A-Za-z][A-Za-z0-9_]{0,31}", args.ns):102 say("--ns는 영문자로 시작하는 32자 안의 영문 · 숫자 · _만 됩니다")103 return 2104 try:105 run(args.ns)106 except ImportError:107 say("ROS 2(rclpy)나 robom_interfaces를 찾지 못했습니다. source /opt/ros/jazzy/setup.bash 와 "108 "source ~/robom_ws/install/setup.bash 를 먼저 했는지 보세요")109 return 2110 return 0111112113if __name__ == "__main__":114 sys.exit(main())