#!/usr/bin/env python3
"""로봄 연습 재배 로봇 노드 — 배지 수분을 받아 기준값과 견주고 밸브를 여는 ROS 2 노드(뼈대).

쓰는 법 (Ubuntu 24.04 + ROS 2 Jazzy):
    source /opt/ros/jazzy/setup.bash
    python3 robom_farm_sim.py
    # 다른 터미널에서 연결기를 켠다: python3 robom_link.py --key <연결 열쇠>

장면: 수분 센서가 배지 수분을 재서 보낸다(연결기가 사이트에서 받아 1초마다 /farm/moisture로 보낸다). 재배 로봇은 받은 값을
자기 기준값과 견줘 밸브를 연다. 농장 관리자는 작물에 따라 기준값을 실행 중에 바꾼다.

- 노드 이름은 robom_farm이다.
- 구독자: /farm/moisture(std_msgs/msg/Float64, 배지 수분 %)를 받을 때마다 결정한다.
- 퍼블리셔: /farm/water(std_msgs/msg/Bool)로 밸브를 연다(수분 < 기준값이면 true).
- --ns <이름>: 노드 · 토픽 이름 앞에 이름 공간을 붙인다(/<이름>/robom_farm). 연결기의 --ns와 같은 이름을 쓴다.

연결 · 구독 · 발행 뼈대는 다 되어 있습니다. 「# 할 일」 자리를 채워 완성하세요. 이 파일을 고쳐 가며 배우세요.
그대로 켜면 기준값이 코드 안의 상수라 사이트에서 읽을 수도 바꿀 수도 없고, 틀린 값을 거절하지도 않아 농장 과제 셋 모두 통과하지 못합니다.

파이썬 표준 라이브러리와 ROS 2에 들어 있는 rclpy · std_msgs · rcl_interfaces만 쓴다(따로 설치할 것이 없다).
"""

import argparse
import re
import sys

VERSION = "2"
PARAM = "moisture_threshold"  # 기준값 파라미터 이름(사이트가 이 이름으로 읽고 바꾼다)
DEFAULT = 40.0  # 기본 기준값(실수)
LOW, HIGH = 0.0, 100.0  # 받아들여야 하는 범위
# 둘러보기: 기준값 상수
THRESHOLD = 40.0  # 할 일: 이 상수 대신 PARAM 이름의 실수 파라미터(기본 DEFAULT)를 선언하고, 결정할 때마다 그 값을 읽으세요.
# 둘러보기 끝


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


# 둘러보기: 밸브 결정
def decide(moisture: float, threshold: float) -> bool:
    """밸브를 열지 정한다: 배지 수분이 기준값보다 낮으면 연다(ROS 2와 상관없는 계산)."""
    return moisture < threshold
# 둘러보기 끝


def run(namespace: str) -> None:
    # rclpy와 메시지 형식은 여기서만 불러온다.
    import rclpy
    from rcl_interfaces.msg import SetParametersResult
    from rclpy.node import Node
    from std_msgs.msg import Bool, Float64

    # 둘러보기: 노드와 퍼블리셔
    rclpy.init()
    node = Node("robom_farm", namespace=f"/{namespace}" if namespace else "")
    water_out = node.create_publisher(Bool, "farm/water" if namespace else "/farm/water", 10)
    # 둘러보기 끝

    # 둘러보기: 파라미터 콜백
    def on_set(parameters) -> SetParametersResult:
        # 파라미터 콜백: 누가 값을 바꾸려 할 때 먼저 불린다. 실패를 돌려주면 값이 그대로다.
        # 할 일: PARAM이 LOW ~ HIGH 밖이면 이유를 담아 거절하세요. 지금은 무엇이든 받아들입니다.
        return SetParametersResult(successful=True)

    node.add_on_set_parameters_callback(on_set)
    # 둘러보기 끝

    # 둘러보기: 수분 받아 결정하기
    def on_moisture(message) -> None:
        # 구독 콜백: 수분이 올 때마다 불린다. 지금의 기준값으로 정해 바로 보낸다.
        threshold = THRESHOLD
        water = decide(message.data, threshold)
        water_out.publish(Bool(data=water))
        say(f"수분 {message.data:.1f} · 기준값 {threshold} → 밸브 {'엶' if water else '닫음'}")

    node.create_subscription(Float64, "farm/moisture" if namespace else "/farm/moisture", on_moisture, 10)
    # 둘러보기 끝
    say(f"로봄 연습 재배 로봇 노드 판 {VERSION} · 노드 {node.get_fully_qualified_name()}")
    # 둘러보기: 노드 돌리기
    try:
        rclpy.spin(node)
    except KeyboardInterrupt:
        say("연습 재배 로봇 노드를 끕니다")
    finally:
        node.destroy_node()
        if rclpy.ok():
            rclpy.shutdown()
    # 둘러보기 끝


def main(argv=None) -> int:
    parser = argparse.ArgumentParser(prog="robom_farm_sim.py", description="로봄 연습 재배 로봇 노드 판 " + VERSION)
    parser.add_argument("--ns", default="", help="이름 공간(예: farm1 → /farm1/robom_farm)")
    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())
