LAB 06 · 에너지

청소 로봇 시각과 주기

태양광 패널 청소 로봇은 2초마다 관제실에 상태 보고를 보냅니다. 관제실은 보고가 5초 넘게 끊기면 그 로봇을 고장으로 보고, 보고에 찍힌 시각으로 언제 마지막으로 소식이 왔는지 압니다. 내 PC에서 청소 로봇 노드를 켜고 로봄 연결기로 잇습니다. 내 노드가 타이머로 2초마다 토픽 /energy/robot_status에 보고를 보내고, 보고마다 노드 시계의 지금 시각을 찍습니다.

연결 순서

누가 무엇을 하나 내 노드(퍼블리셔, 2초마다 상태 보고) → /energy/robot_status → 연결기(구독자) → 로봄 서버 → 관제실 그림 · 과제 줄

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

ros2 topic hz /energy/robot_status
ros2 topic echo /energy/robot_status
  1. ROS 2 환경 확인

    Ubuntu 24.04 + ROS 2 Jazzy가 필요합니다. 윈도우는 WSL의 Ubuntu에서 합니다. 아래를 차례로 쳐서 jazzy와 메시지 형식(builtin_interfaces/Time stamp)이 나오면 됩니다. std_msgs는 ROS 2에 늘 들어 있어 따로 깔 것이 없습니다.

    source /opt/ros/jazzy/setup.bash
    printenv ROS_DISTRO
    ros2 interface show std_msgs/msg/Header
  2. 연결기 · 연습 노드 내려받기

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

    판 4 · SHA-256 5d4b39f350347fdff1770652a149b9f9549ddeae195802dcbe29c7a71a3eaa22

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

    연습 청소 로봇 노드 내려받기 (robom_energy_sim.py)

    판 2 · SHA-256 8b399ef659ef9aee2d2aa9e6e30af3db16b065ab96de2ffbd5824e9083dda94e

    연습 노드는 연결 · 퍼블리셔 · 청소 동작 뼈대가 되어 있고, 주기와 시각은 「# 할 일」로 비어 있습니다. 그대로 켜면(python3 robom_energy_sim.py) 보고 간격이 2.5초이고 시각이 0이라 두 과제 모두 떨어집니다. 「# 할 일」을 채워 완성하세요. ROS 2 없이 네트워크만 먼저 볼 때는 연결기의 --demo를 씁니다(연습 모드라서 확인받기는 되지 않습니다). 가짜 청소 로봇은 패널 그림만 움직이는 모양만 맞는 보고(2.5초 간격 · 멈춘 시각)를 보냅니다.

  3. 연결 열쇠 받기

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

    로그인하고 열쇠 받기

  4. 파일 둘러보기

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

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

    1 · 한 장 그림

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

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

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

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

      /energy/robot_status(지켜보기)가 이 표에 있어야 연결기가 다룹니다.

      # ── 판 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 지켜본 메시지 올리기 305번째 줄부터

      구독해서 받은 상태 보고를 이 PC가 받은 시각과 함께 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, "지켜본 메시지 올리기")
    3. 3 지켜볼 토픽 구독 690번째 줄부터

      켤 때 /energy/robot_status를 구독해 둡니다.

      for topic, type_name in WATCH_TOPICS.items():
          node.create_subscription(self._need(type_name), self.prefix + topic, self._watcher(topic, type_name), 10)
    4. 4 받은 메시지 담기 750번째 줄부터

      받은 Header의 stamp · frame_id를 값으로 바꿔 올릴 묶음에 넣습니다.

      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

    3 · 연습 노드 읽기 robom_energy_sim.py

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

    #!/usr/bin/env python3"""로봄 연습 청소 로봇 노드 — 태양광 패널을 돌며 청소하고 관제실에 상태 보고를 보내는 ROS 2 노드(뼈대).쓰는 법 (Ubuntu 24.04 + ROS 2 Jazzy):    source /opt/ros/jazzy/setup.bash    python3 robom_energy_sim.py    # 다른 터미널에서 연결기를 켠다: python3 robom_link.py --key <연결 열쇠>장면: 청소 로봇은 2초마다 상태 보고를 보낸다. 관제실은 보고가 5초 넘게 끊기면 고장으로 보고,보고에 찍힌 시각(stamp)으로 「언제 마지막으로 소식이 왔는지」를 안다.- 퍼블리셔: /energy/robot_status(std_msgs/msg/Header)를 보낸다.  frame_id = 지금 청소 중인 패널의 좌표계 이름(panel_1 ~ panel_4). frame_id는 원래 좌표계 이름이고, 여기서는 패널마다 좌표계가 있다고 본다.  stamp = 노드 시계의 지금 시각.- --ns <이름>: 토픽 이름 앞에 이름 공간을 붙인다(/<이름>/energy/robot_status). 연결기의 --ns와 같은 이름을 쓴다.연결 · 퍼블리셔 · 청소 동작 뼈대는 다 되어 있습니다. 「# 할 일」 자리를 채워 완성하세요. 이 파일을 고쳐 가며 배우세요.그대로 켜면 청소(0.5초)에 기다림(2초)이 더해져 보고 간격이 2.5초가 되고, 시각도 비어 있어(stamp 0) 에너지 과제를 통과하지 못합니다.파이썬 표준 라이브러리와 ROS 2에 들어 있는 rclpy · std_msgs만 쓴다(따로 설치할 것이 없다)."""import argparseimport reimport sysimport timeVERSION = "2"PERIOD = 2.0  # 상태 보고 주기(초)CLEAN_SECONDS = 0.5  # 패널 하나를 한 번 닦는 데 걸리는 시간(초)PANELS = 4  # 돌아가며 청소하는 패널 수def say(text: str) -> None:    print(text, flush=True)

    패널 고르기 · 닦기 뼈대

    몇 번째 보고인지로 청소할 패널 이름을 고르고, 닦는 데 0.5초를 씁니다.

    def panel_frame(count: int) -> str:    """count번째(1부터) 보고의 frame_id: 패널 넷을 돌아가며 청소한다(ROS 2와 상관없는 계산)."""    return f"panel_{(count - 1) % PANELS + 1}"def clean(panel: str) -> None:    """패널 하나를 닦는다(여기서는 시간만 쓴다)."""    time.sleep(CLEAN_SECONDS)
    def run(namespace: str) -> None:    # rclpy와 메시지 형식은 여기서만 불러온다.    import rclpy    from rclpy.node import Node    from std_msgs.msg import Header

    퍼블리셔 만들기 뼈대

    상태 보고를 보낼 퍼블리셔를 만듭니다.

        topic = f"/{namespace}/energy/robot_status" if namespace else "/energy/robot_status"    rclpy.init()    node = Node("robom_energy_sim")    status = node.create_publisher(Header, topic, 10)  # 상태 보고를 보낼 토픽
        count = 0    say(f"로봄 연습 청소 로봇 노드 판 {VERSION} · {topic}")

    보고 반복 내가 채움 과제 1 · 주기마다 보내기, 과제 2 · 시각 찍기

    패널을 닦고 상태 보고를 보내는 반복으로, 주기를 지키는 방법과 시각을 찍는 자리가 여기입니다.

        try:        # 할 일: while과 sleep으로 기다리면 청소에 걸린 시간만큼 주기가 밀립니다(2.0 + 0.5 = 2.5초).과제 1 · 주기마다 보내기        #        기다리는 시간을 직접 세지 말고, 일에 걸린 시간과 상관없이 2초마다 콜백이 불리게 노드에 맡기세요.        #        그 콜백 안에서 닦고 보고합니다.        while rclpy.ok():            count += 1            header = Header(frame_id=panel_frame(count))            clean(header.frame_id)            # 할 일: 보낼 때마다 header.stamp에 노드 시계의 지금 시각을 넣으세요(비우면 stamp가 0입니다).과제 2 · 시각 찍기            status.publish(header)            say(f"상태 보고: {header.frame_id} · stamp {header.stamp.sec}.{header.stamp.nanosec:09d}")            time.sleep(PERIOD)    except KeyboardInterrupt:        say("연습 청소 로봇 노드를 끕니다")    finally:        node.destroy_node()        if rclpy.ok():            rclpy.shutdown()
    def main(argv=None) -> int:    parser = argparse.ArgumentParser(prog="robom_energy_sim.py", description="로봄 연습 청소 로봇 노드 판 " + VERSION)    parser.add_argument("--ns", default="", help="토픽 이름 공간(예: robot1 → /robot1/energy/robot_status)")    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)를 찾지 못했습니다. source /opt/ros/jazzy/setup.bash 를 먼저 하세요")        return 2    return 0if __name__ == "__main__":    sys.exit(main())

    지도로 가기

  5. 연결기 켜기

    연결기 파일이 있는 폴더에서 실행합니다. 「연결됨」이 뜨면 상태 보고가 패널 그림과 주기 막대에 그려집니다.

에너지 · 태양광 패널과 청소 로봇

연결 안 됨

frame_id는 원래 좌표계 이름이고, 여기서는 패널마다 좌표계(panel_1 ~ panel_4)가 있다고 봅니다. 보고의 frame_id가 로봇이 지금 청소 중인 패널입니다.

  1. panel_1 보고 없음
  2. panel_2 보고 없음
  3. panel_3 보고 없음
  4. panel_4 보고 없음

로봇의 가장 새 보고가 5초 넘게 끊기면 관제실은 로봇을 「고장 의심」으로 칠합니다. 패널마다의 「n초 전」은 로봇이 패널 넷을 돌기 때문에 정상일 때도 8초 가까이 갑니다. 「n초 전」은 연결기가 보고를 받은 때로 세고, 작은 숫자는 보고에 찍힌 stamp(유닉스 초)입니다.

주기 막대 · 최근 상태 보고 10개의 간격

옅은 띠가 2.0초 ± 0.3초(1.7~2.3초)입니다. 막대가 띠 안에 있으면 주기가 맞습니다. 간격은 연결기가 받은 시각으로 잽니다.

    받은 보고
    0
    마지막 패널
    -
    찍은 시각
    -

    과제 칸

    통과 0/2

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

    과제 1 · 주기마다 보내기

    관제실은 청소 로봇의 상태 보고가 5초 넘게 끊기면 고장으로 봅니다. 로봇이 정해진 주기(2초)를 지켜야 관제실이 멀쩡한 로봇을 고장으로 오해하지 않습니다.

    내 PC에서 2초마다 토픽 /energy/robot_status 로 상태 보고(형식 std_msgs/msg/Header)를 보내는 노드를 켜세요. frame_id에는 지금 청소 중인 패널의 좌표계 이름(panel_1 ~ panel_4)을 넣습니다. 연속 상태 보고 10개의 간격이 모두 2초 ± 0.3초(1.7~2.3초)이면 「확인받기」로 통과합니다.

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

    힌트 보기
    • 연습 청소 로봇 노드(robom_energy_sim.py)를 먼저 켜고, 다른 터미널에서 연결기를 켭니다. 두 터미널 모두 source /opt/ros/jazzy/setup.bash를 먼저 합니다.
    • 연습 노드는 청소(0.5초)를 한 뒤 2초를 기다리므로 실제 간격이 2.5초입니다. 기다리는 시간을 직접 세지 말고, rclpy가 정해진 주기마다 콜백을 부르게 하는 방법을 찾아보세요.
    • 다른 터미널에서 ros2 topic hz /energy/robot_status 를 치면 내 노드가 실제로 몇 초마다 보내는지 보입니다.

    과제 2 · 시각 찍기

    관제실은 보고에 찍힌 시각을 보고 「이 로봇에게서 언제 마지막으로 소식이 왔는지」를 압니다. 시각이 비었거나 멈춰 있으면 살아 있는 로봇인지 알 수 없습니다.

    상태 보고를 보낼 때마다 Header의 stamp에 노드 시계의 지금 시각을 찍으세요. 상태 보고 10개 모두 stamp가 연결기가 받은 시각과 1초 안이면 「확인받기」로 통과합니다.

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

    힌트 보기
    • 노드는 자기 시계를 가지고 있습니다. 보낼 때마다 그 시계의 지금 시각을 읽어 Header 메시지 형식에 맞게 바꿔 stamp에 넣으세요.
    • 다른 터미널에서 ros2 topic echo /energy/robot_status 를 치면 stamp의 sec가 보낼 때마다 2씩 늘어나는지 보입니다. 0이거나 늘 같으면 아직 찍지 않은 것입니다.