#!/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 argparse
import re
import sys
import time

VERSION = "2"
PERIOD = 2.0  # 상태 보고 주기(초)
CLEAN_SECONDS = 0.5  # 패널 하나를 한 번 닦는 데 걸리는 시간(초)
PANELS = 4  # 돌아가며 청소하는 패널 수


def say(text: str) -> None:
    print(text, flush=True)


# 둘러보기: 패널 고르기 · 닦기
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}")
    # 둘러보기: 보고 반복
    try:
        # 할 일: while과 sleep으로 기다리면 청소에 걸린 시간만큼 주기가 밀립니다(2.0 + 0.5 = 2.5초).
        #        기다리는 시간을 직접 세지 말고, 일에 걸린 시간과 상관없이 2초마다 콜백이 불리게 노드에 맡기세요.
        #        그 콜백 안에서 닦고 보고합니다.
        while rclpy.ok():
            count += 1
            header = Header(frame_id=panel_frame(count))
            clean(header.frame_id)
            # 할 일: 보낼 때마다 header.stamp에 노드 시계의 지금 시각을 넣으세요(비우면 stamp가 0입니다).
            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 0


if __name__ == "__main__":
    sys.exit(main())
