연결기는 이 실습실에서 아래 9곳을 씁니다. 내 PC의 ROS 2 쪽에서는 퍼블리셔 · 구독자 · 서비스 · 액션 · 파라미터 클라이언트 노릇을, 사이트 쪽에서는 HTTP로 묻고 올리는 노릇을 합니다.
-
1 허용 목록 52번째 줄부터
/farm/moisture(보내기) · /farm/water(지켜보기) · /robom_farm(파라미터)이 이 표에 있어야 연결기가 다룹니다.
# ── 판 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 보낼 토픽 퍼블리셔 686번째 줄부터
켤 때 /farm/moisture 퍼블리셔를 미리 만듭니다.
# 보낼 토픽의 퍼블리셔는 켤 때 미리 만든다(처음 보낸 메시지를 구독자가 놓치지 않게)
self.publishers = {topic: node.create_publisher(self._need(t), self.prefix + topic, 10) for topic, t in PUBLISH_TOPICS.items()}
-
5 지켜볼 토픽 구독 690번째 줄부터
켤 때 /farm/water를 구독해 둡니다.
for topic, type_name in WATCH_TOPICS.items():
node.create_subscription(self._need(type_name), self.prefix + topic, self._watcher(topic, type_name), 10)
-
6 파라미터 클라이언트 695번째 줄부터
/robom_farm 노드의 파라미터를 읽고 바꿀 서비스 클라이언트를 미리 만듭니다.
# 파라미터 클라이언트도 미리 만든다(처음 만든 클라이언트는 ROS 2 발견에 몇 초 걸린다)
self.param = {name: self._need(t) for name, t in PARAM_TYPES.items()}
self.param_clients = {}
for target in PARAM_NODES:
self.param_clients[(target, "param_get")] = node.create_client(self.param["get"], self.prefix + target + "/get_parameters")
self.param_clients[(target, "param_set")] = node.create_client(self.param["set"], self.prefix + target + "/set_parameters")
-
7 받은 메시지 담기 750번째 줄부터
받은 Bool을 값으로 바꿔 올릴 묶음에 넣습니다.
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
-
8 토픽 보내기 790번째 줄부터
여기서 서버가 보낸 수분을 /farm/moisture로 내보냅니다.
def _publish(self, line: dict) -> None:
topic = line["topic"]
value = line["data"]["data"]
message = self._type(PUBLISH_TOPICS[topic])(data=float(value) if PUBLISH_TOPICS[topic].endswith("Float64") else value)
self.publishers[topic].publish(message)
if topic in REPEAT_TOPICS:
self.repeat[topic] = [message, time.monotonic() + REPEAT_EVERY]
self.link.report({"id": line["id"], "kind": "topic_published"})
-
9 파라미터 부르기 898번째 줄부터
기준값을 읽거나 바꾸는 요청을 보내고, 받아들였는지 · 거절 이유를 서버로 올립니다.
def _call_param(self, line: dict, client) -> None:
rid, name = line["id"], line["name"]
if line["kind"] == "param_get":
request = self.param["get"].Request()
request.names = [name]
def got(future) -> None:
values = future.result().values
self._answer(rid, {"kind": "param_values", "values": {name: param_python(values[0]) if values else None}})
callback = got
else:
request = self.param["set"].Request()
request.parameters = [self.param["parameter"](name=name, value=param_message(self.param["value"], line["value"]))]
def done(future) -> None:
results = future.result().results
ok = bool(results and results[0].successful)
reason = str(results[0].reason)[:200] if results else "노드가 답을 주지 않았습니다"
self._answer(rid, {"kind": "param_set_result", "successful": ok, "reason": reason})
callback = done
future = client.call_async(request)
future.add_done_callback(callback)
self.calling.append((time.monotonic() + PARAM_FIND_SECONDS, rid, future))
파일 전체입니다(표지 주석 줄만 뺐습니다). 그대로 두는 뼈대는 어두운 바탕, 내가 채우거나 고칠 줄(「# 할 일」 주석과 그 자리의 코드)은 노란 바탕이고, 「# 할 일」 옆에 그 과제 이름이 있습니다.
1#!/usr/bin/env python32"""로봄 연습 재배 로봇 노드 — 배지 수분을 받아 기준값과 견주고 밸브를 여는 ROS 2 노드(뼈대).34쓰는 법 (Ubuntu 24.04 + ROS 2 Jazzy):5 source /opt/ros/jazzy/setup.bash6 python3 robom_farm_sim.py7 # 다른 터미널에서 연결기를 켠다: python3 robom_link.py --key <연결 열쇠>89장면: 수분 센서가 배지 수분을 재서 보낸다(연결기가 사이트에서 받아 1초마다 /farm/moisture로 보낸다). 재배 로봇은 받은 값을10자기 기준값과 견줘 밸브를 연다. 농장 관리자는 작물에 따라 기준값을 실행 중에 바꾼다.1112- 노드 이름은 robom_farm이다.13- 구독자: /farm/moisture(std_msgs/msg/Float64, 배지 수분 %)를 받을 때마다 결정한다.14- 퍼블리셔: /farm/water(std_msgs/msg/Bool)로 밸브를 연다(수분 < 기준값이면 true).15- --ns <이름>: 노드 · 토픽 이름 앞에 이름 공간을 붙인다(/<이름>/robom_farm). 연결기의 --ns와 같은 이름을 쓴다.1617연결 · 구독 · 발행 뼈대는 다 되어 있습니다. 「# 할 일」 자리를 채워 완성하세요. 이 파일을 고쳐 가며 배우세요.18그대로 켜면 기준값이 코드 안의 상수라 사이트에서 읽을 수도 바꿀 수도 없고, 틀린 값을 거절하지도 않아 농장 과제 셋 모두 통과하지 못합니다.1920파이썬 표준 라이브러리와 ROS 2에 들어 있는 rclpy · std_msgs · rcl_interfaces만 쓴다(따로 설치할 것이 없다).21"""2223import argparse24import re25import sys2627VERSION = "2"28PARAM = "moisture_threshold" # 기준값 파라미터 이름(사이트가 이 이름으로 읽고 바꾼다)29DEFAULT = 40.0 # 기본 기준값(실수)30LOW, HIGH = 0.0, 100.0 # 받아들여야 하는 범위
기준값 상수 내가 채움 과제 1 · 파라미터 선언, 과제 2 · 바꾼 값 따르기
지금은 코드 안 상수인 기준값을 바깥에서 읽고 바꿀 수 있는 파라미터로 내놓는 자리입니다.
32THRESHOLD = 40.0 # 할 일: 이 상수 대신 PARAM 이름의 실수 파라미터(기본 DEFAULT)를 선언하고, 결정할 때마다 그 값을 읽으세요.과제 1 · 파라미터 선언, 과제 2 · 바꾼 값 따르기과제 1 · 2
343536def say(text: str) -> None:37 print(text, flush=True)3839
밸브 결정 뼈대
수분이 기준값보다 낮으면 밸브를 여는, ROS 2와 상관없는 계산입니다.
41def decide(moisture: float, threshold: float) -> bool:42 """밸브를 열지 정한다: 배지 수분이 기준값보다 낮으면 연다(ROS 2와 상관없는 계산)."""43 return moisture < threshold
454647def run(namespace: str) -> None:48 # rclpy와 메시지 형식은 여기서만 불러온다.49 import rclpy50 from rcl_interfaces.msg import SetParametersResult51 from rclpy.node import Node52 from std_msgs.msg import Bool, Float6453
노드와 퍼블리셔 뼈대
/robom_farm 노드와 물 결정을 보낼 퍼블리셔를 만듭니다.
55 rclpy.init()56 node = Node("robom_farm", namespace=f"/{namespace}" if namespace else "")57 water_out = node.create_publisher(Bool, "farm/water" if namespace else "/farm/water", 10)
파라미터 콜백 내가 채움 과제 3 · 틀린 값 거절하기
누가 값을 바꾸려 할 때 먼저 불려, 범위 밖이면 거절하는 자리입니다.
61 def on_set(parameters) -> SetParametersResult:62 # 파라미터 콜백: 누가 값을 바꾸려 할 때 먼저 불린다. 실패를 돌려주면 값이 그대로다.63 # 할 일: PARAM이 LOW ~ HIGH 밖이면 이유를 담아 거절하세요. 지금은 무엇이든 받아들입니다.과제 3 · 틀린 값 거절하기과제 3 · 틀린 값 거절하기64 return SetParametersResult(successful=True)6566 node.add_on_set_parameters_callback(on_set)
수분 받아 결정하기 내가 채움 과제 2 · 바꾼 값 따르기
구독 콜백으로, 수분이 올 때마다 그때의 기준값으로 정해 바로 보내므로 기준값을 어디서 읽는지가 중요합니다.
70 def on_moisture(message) -> None:71 # 구독 콜백: 수분이 올 때마다 불린다. 지금의 기준값으로 정해 바로 보낸다.72 threshold = THRESHOLD73 water = decide(message.data, threshold)74 water_out.publish(Bool(data=water))75 say(f"수분 {message.data:.1f} · 기준값 {threshold} → 밸브 {'엶' if water else '닫음'}")7677 node.create_subscription(Float64, "farm/moisture" if namespace else "/farm/moisture", on_moisture, 10)
79 say(f"로봄 연습 재배 로봇 노드 판 {VERSION} · 노드 {node.get_fully_qualified_name()}")
노드 돌리기 뼈대
노드를 돌려 콜백이 불리게 하고, 끌 때 정리합니다.
81 try:82 rclpy.spin(node)83 except KeyboardInterrupt:84 say("연습 재배 로봇 노드를 끕니다")85 finally:86 node.destroy_node()87 if rclpy.ok():88 rclpy.shutdown()
909192def main(argv=None) -> int:93 parser = argparse.ArgumentParser(prog="robom_farm_sim.py", description="로봄 연습 재배 로봇 노드 판 " + VERSION)94 parser.add_argument("--ns", default="", help="이름 공간(예: farm1 → /farm1/robom_farm)")95 args = parser.parse_args(argv)96 if args.ns and not re.fullmatch(r"[A-Za-z][A-Za-z0-9_]{0,31}", args.ns):97 say("--ns는 영문자로 시작하는 32자 안의 영문 · 숫자 · _만 됩니다")98 return 299 try:100 run(args.ns)101 except ImportError:102 say("ROS 2(rclpy)를 찾지 못했습니다. source /opt/ros/jazzy/setup.bash 를 먼저 하세요")103 return 2104 return 0105106107if __name__ == "__main__":108 sys.exit(main())