RotateAction.py

"""
RotateAction — 原地旋转指定相对角度
功能：从当前朝向旋转指定弧度
      正数 = 逆时针旋转，负数 = 顺时针旋转
"""

import math
import time
import requests

# ── 配置 ──────────────────────────────────────────────
ROBOT_IP = "10.160.129.252"
PORT     = 1448
BASE_URL = f"http://{ROBOT_IP}:{PORT}/api/core/motion/v1/actions"

# 绕过系统代理（避免 127.0.0.1:7890 超时）
SESSION = __import__("requests").Session()
SESSION.trust_env = False

# 旋转角度（弧度）
# 正数=逆时针，负数=顺时针
# 示例：math.pi/2 = 逆时针90°   -math.pi = 顺时针180°
ROTATE_ANGLE = math.pi / 2   # 逆时针 90°

POLL_INTERVAL_S = 0.5
# ──────────────────────────────────────────────────────


def build_payload():
    return {
        "action_name": "agent.actions.RotateAction",
        "options": {"angle": ROTATE_ANGLE},
    }


def poll_until_done(action_id):
    url = f"{BASE_URL}/{action_id}"
    while True:
        resp = SESSION.get(url, timeout=5)
        data = resp.json()
        status = data["state"]["status"]
        result = data["state"]["result"]
        reason = data["state"].get("reason", "")

        if status == 4:
            if result == 0:
                direction = "逆时针" if ROTATE_ANGLE >= 0 else "顺时针"
                print(f"[完成] action_id={action_id} {direction}旋转 {abs(math.degrees(ROTATE_ANGLE)):.1f}° 完成")
            else:
                print(f"[失败] action_id={action_id} result={result} reason={reason}")
            return result == 0

        status_desc = {0: "初始化", 1: "旋转中"}.get(status, str(status))
        print(f"[{status_desc}] action_id={action_id} ...")
        time.sleep(POLL_INTERVAL_S)


def main():
    direction = "逆时针" if ROTATE_ANGLE >= 0 else "顺时针"
    deg = abs(math.degrees(ROTATE_ANGLE))
    print(f"[RotateAction] {direction}旋转 {deg:.1f}°（{ROTATE_ANGLE:.4f} rad）")

    payload = build_payload()
    resp = SESSION.post(BASE_URL, json=payload, timeout=5)
    if resp.status_code != 200:
        print(f"[错误] HTTP {resp.status_code}: {resp.text}")
        return

    data = resp.json()
    action_id = data["action_id"]
    print(f"[已创建] action_id={action_id}")

    poll_until_done(action_id)


if __name__ == "__main__":
    main()