2026-10-17 17:49:47 +08:00
|
|
|
|
// Package agv 海康 AGV 调度系统(RCS-Lite V1.5) 对接客户端(2026-10-17 由 RCS-2000 改为 RCS-Lite 1.5)。
|
|
|
|
|
|
// 能力:生成搬运任务(genAgvSchedulingTask)、查询任务状态(queryTaskStatus)、取消任务(cancelTask)。
|
|
|
|
|
|
// 协议详见《AGV海康litev1.5.md》:无签名;所有参数统一字符串;成功 code=="0"。
|
|
|
|
|
|
// 完整请求路径 = BaseURL(已含 /rCMS/services/rest/hikRpcService) + 业务路径。
|
|
|
|
|
|
// 未配置真实 RCS(BaseURL 为空) 或 EnableMock=true 时走 Mock 客户端。
|
2026-09-04 14:18:53 +08:00
|
|
|
|
package agv
|
|
|
|
|
|
|
|
|
|
|
|
import (
|
|
|
|
|
|
"bytes"
|
|
|
|
|
|
"context"
|
|
|
|
|
|
"encoding/json"
|
|
|
|
|
|
"fmt"
|
|
|
|
|
|
"io"
|
|
|
|
|
|
"net/http"
|
|
|
|
|
|
"strings"
|
|
|
|
|
|
"time"
|
|
|
|
|
|
|
2026-10-17 17:49:47 +08:00
|
|
|
|
"github.com/google/uuid"
|
|
|
|
|
|
|
2026-10-14 17:24:59 +08:00
|
|
|
|
"bj_power_mes/internal/config"
|
2026-09-04 14:18:53 +08:00
|
|
|
|
)
|
|
|
|
|
|
|
|
|
|
|
|
// Client AGV 调度客户端抽象
|
|
|
|
|
|
type Client interface {
|
2026-10-17 17:49:47 +08:00
|
|
|
|
// SubmitTask 下发搬运任务 fromDock -> toDock。taskCode 为我方任务单号(透传给 RCS 便于回查)。
|
|
|
|
|
|
// 成功返回该 taskCode(RCS-Lite 不下发明文任务码,以我方 taskCode 为唯一追踪键)。
|
|
|
|
|
|
SubmitTask(ctx context.Context, taskCode, fromDock, toDock, carrierCode string) (string, error)
|
2026-11-04 19:06:03 +08:00
|
|
|
|
// QueryTask 查询任务状态,返回 RCS 数字状态:"1"已创建/"2"执行中/"5"取消完成/"9"已结束;
|
|
|
|
|
|
// 第二返回值为 RCS 分配的车辆编号 agvCode(任务分车后回传,用于绑定 agv_vehicle_state;可能为空)。
|
|
|
|
|
|
QueryTask(ctx context.Context, taskCode string) (status string, agvCode string, err error)
|
2026-10-17 17:49:47 +08:00
|
|
|
|
// CancelTask 取消任务(按 taskCode)。
|
|
|
|
|
|
CancelTask(ctx context.Context, taskCode, reason string) error
|
2026-11-03 18:29:31 +08:00
|
|
|
|
// QueryAgvStatus 只读获取车辆状态(3.1.7 queryAgvStatus):车辆闲忙/充电/电量/位置。
|
|
|
|
|
|
// 纯只读展示,不参与调度(调度完全交给 RCS 自身)。
|
|
|
|
|
|
QueryAgvStatus(ctx context.Context) ([]AgvVehicle, error)
|
2026-09-17 19:41:00 +08:00
|
|
|
|
// Disable 是否处于 Mock(未接真实 RCS)模式。
|
|
|
|
|
|
Disable() bool
|
2026-09-04 14:18:53 +08:00
|
|
|
|
}
|
|
|
|
|
|
|
2026-11-03 18:29:31 +08:00
|
|
|
|
// AgvVehicle 3.1.7 返回的单车状态(只读展示用,不参与调度)。
|
|
|
|
|
|
type AgvVehicle struct {
|
|
|
|
|
|
RobotCode string `json:"robotCode"` // 机器人编号
|
|
|
|
|
|
Battery float64 `json:"battery"` // 电量 0-100
|
|
|
|
|
|
Status string `json:"status"` // 状态:4=任务空闲 / 2=执行中 / 7=充电 / 其它见协议 5.1
|
|
|
|
|
|
PodCode string `json:"podCode"` // 背货架编号(0/空=未背货)
|
|
|
|
|
|
PosX float64 `json:"posX"`
|
|
|
|
|
|
PosY float64 `json:"posY"`
|
|
|
|
|
|
Stop bool `json:"stop"` // 是否暂停
|
|
|
|
|
|
}
|
|
|
|
|
|
|
2026-09-04 14:18:53 +08:00
|
|
|
|
// New 依据配置返回真实或 Mock 客户端
|
2026-10-14 17:24:59 +08:00
|
|
|
|
func New(cfg config.AgvConf) Client {
|
2026-09-04 14:18:53 +08:00
|
|
|
|
if cfg.EnableMock || cfg.BaseURL == "" {
|
|
|
|
|
|
return newMockClient()
|
|
|
|
|
|
}
|
|
|
|
|
|
return newRealClient(cfg)
|
|
|
|
|
|
}
|
|
|
|
|
|
|
2026-10-17 17:49:47 +08:00
|
|
|
|
// ---------- 请求与响应(真实海康 RCS-Lite) ----------
|
2026-09-04 14:18:53 +08:00
|
|
|
|
|
|
|
|
|
|
type realClient struct {
|
2026-10-14 17:24:59 +08:00
|
|
|
|
cfg config.AgvConf
|
2026-09-17 19:41:00 +08:00
|
|
|
|
hc *http.Client
|
|
|
|
|
|
carrier string
|
2026-09-04 14:18:53 +08:00
|
|
|
|
}
|
|
|
|
|
|
|
2026-10-14 17:24:59 +08:00
|
|
|
|
func newRealClient(cfg config.AgvConf) *realClient {
|
2026-09-04 14:18:53 +08:00
|
|
|
|
return &realClient{
|
|
|
|
|
|
cfg: cfg,
|
|
|
|
|
|
hc: &http.Client{Timeout: 15 * time.Second},
|
|
|
|
|
|
carrier: cfg.CarrierCode,
|
|
|
|
|
|
}
|
|
|
|
|
|
}
|
|
|
|
|
|
|
2026-10-17 17:49:47 +08:00
|
|
|
|
// url 拼接 RCS-Lite 基础地址 + 业务路径(BaseURL 已含 /rCMS/services/rest/hikRpcService)。
|
2026-09-04 14:18:53 +08:00
|
|
|
|
func (c *realClient) url(path string) string {
|
2026-10-17 17:49:47 +08:00
|
|
|
|
return strings.TrimRight(c.cfg.BaseURL, "/") + path
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
// envelope RCS-Lite 统一响应信封(§1.4):code 必填、message 必填、reqCode 回传、data 选填。
|
|
|
|
|
|
type envelope struct {
|
|
|
|
|
|
Code string `json:"code"`
|
|
|
|
|
|
Message string `json:"message"`
|
|
|
|
|
|
ReqCode string `json:"reqCode"`
|
|
|
|
|
|
Data json.RawMessage `json:"data"`
|
2026-09-04 14:18:53 +08:00
|
|
|
|
}
|
|
|
|
|
|
|
2026-10-17 17:49:47 +08:00
|
|
|
|
// call POST 到 RCS-Lite 并解析信封。成功判定 code=="0";out 非空时把 data 反序列化进去。
|
|
|
|
|
|
func (c *realClient) call(ctx context.Context, path string, payload map[string]any, out any) error {
|
|
|
|
|
|
if payload == nil {
|
|
|
|
|
|
payload = map[string]any{}
|
|
|
|
|
|
}
|
|
|
|
|
|
payload["reqCode"] = uuid.NewString()
|
|
|
|
|
|
payload["reqTime"] = time.Now().Format("2006-01-02 15:04:05")
|
|
|
|
|
|
|
2026-09-04 14:18:53 +08:00
|
|
|
|
body, err := json.Marshal(payload)
|
|
|
|
|
|
if err != nil {
|
|
|
|
|
|
return err
|
|
|
|
|
|
}
|
|
|
|
|
|
req, err := http.NewRequestWithContext(ctx, http.MethodPost, c.url(path), bytes.NewReader(body))
|
|
|
|
|
|
if err != nil {
|
|
|
|
|
|
return err
|
|
|
|
|
|
}
|
2026-10-17 17:49:47 +08:00
|
|
|
|
req.Header.Set("Content-Type", "application/json;charset=UTF-8")
|
|
|
|
|
|
|
2026-09-04 14:18:53 +08:00
|
|
|
|
resp, err := c.hc.Do(req)
|
|
|
|
|
|
if err != nil {
|
|
|
|
|
|
return err
|
|
|
|
|
|
}
|
|
|
|
|
|
defer resp.Body.Close()
|
|
|
|
|
|
raw, err := io.ReadAll(resp.Body)
|
|
|
|
|
|
if err != nil {
|
|
|
|
|
|
return err
|
|
|
|
|
|
}
|
|
|
|
|
|
if resp.StatusCode >= 400 {
|
|
|
|
|
|
return fmt.Errorf("agv http %d: %s", resp.StatusCode, string(raw))
|
|
|
|
|
|
}
|
2026-10-17 17:49:47 +08:00
|
|
|
|
var env envelope
|
|
|
|
|
|
if err := json.Unmarshal(raw, &env); err != nil {
|
2026-09-04 14:18:53 +08:00
|
|
|
|
return fmt.Errorf("agv parse envelope: %w", err)
|
|
|
|
|
|
}
|
2026-10-17 17:49:47 +08:00
|
|
|
|
// 成功码固定字符串 "0"(§1.5 结果码定义)
|
|
|
|
|
|
if env.Code != "0" {
|
|
|
|
|
|
return fmt.Errorf("agv code=%s message=%s", env.Code, env.Message)
|
2026-09-04 14:18:53 +08:00
|
|
|
|
}
|
2026-10-17 17:49:47 +08:00
|
|
|
|
if out != nil && len(env.Data) > 0 {
|
|
|
|
|
|
return json.Unmarshal(env.Data, out)
|
2026-09-04 14:18:53 +08:00
|
|
|
|
}
|
|
|
|
|
|
return nil
|
|
|
|
|
|
}
|
|
|
|
|
|
|
2026-10-17 17:49:47 +08:00
|
|
|
|
// SubmitTask 实现 Client:生成搬运任务(genAgvSchedulingTask)。
|
2026-11-03 18:29:31 +08:00
|
|
|
|
// 两点搬运:源点(fromDock) → 目标点(toDock) 用 positionCodePath 两个点(type=00 位置编号)表达。
|
|
|
|
|
|
// 空车段(fromDock 为空,2026-11-03 三段链模型):仅下发目标点单点 path,由 RCS 派最近空闲车前往——
|
|
|
|
|
|
// 对应「业务自动触发免弹窗」的空车去程(AGV 空车前往装货点);若现场 RCS 要求两点 path,联调时改为 [充电位, 装货点]。
|
2026-10-17 17:49:47 +08:00
|
|
|
|
// 任务类型固定 F01(厂内货架搬运);taskCode 透传我方任务单号。
|
|
|
|
|
|
func (c *realClient) SubmitTask(ctx context.Context, taskCode, fromDock, toDock, carrierCode string) (string, error) {
|
2026-11-03 18:29:31 +08:00
|
|
|
|
path := []map[string]any{
|
|
|
|
|
|
{"positionCode": toDock, "type": "00"},
|
|
|
|
|
|
}
|
|
|
|
|
|
if fromDock != "" {
|
|
|
|
|
|
path = []map[string]any{
|
2026-10-17 17:49:47 +08:00
|
|
|
|
{"positionCode": fromDock, "type": "00"},
|
|
|
|
|
|
{"positionCode": toDock, "type": "00"},
|
2026-11-03 18:29:31 +08:00
|
|
|
|
}
|
|
|
|
|
|
}
|
|
|
|
|
|
payload := map[string]any{
|
|
|
|
|
|
"taskTyp": "F01",
|
|
|
|
|
|
"positionCodePath": path,
|
|
|
|
|
|
"priority": c.cfg.Priority,
|
|
|
|
|
|
"taskCode": taskCode,
|
2026-09-17 19:41:00 +08:00
|
|
|
|
}
|
|
|
|
|
|
carrier := carrierCode
|
|
|
|
|
|
if carrier == "" {
|
|
|
|
|
|
carrier = c.carrier
|
|
|
|
|
|
}
|
|
|
|
|
|
if carrier != "" {
|
2026-10-17 17:49:47 +08:00
|
|
|
|
payload["podCode"] = carrier // 载具/托盘编号(选填)
|
2026-09-04 14:18:53 +08:00
|
|
|
|
}
|
2026-10-17 17:49:47 +08:00
|
|
|
|
if err := c.call(ctx, "/genAgvSchedulingTask", payload, nil); err != nil {
|
2026-09-04 14:18:53 +08:00
|
|
|
|
return "", err
|
|
|
|
|
|
}
|
2026-10-17 17:49:47 +08:00
|
|
|
|
// RCS-Lite 不下发明文任务码,以我方 taskCode 为追踪键
|
|
|
|
|
|
return taskCode, nil
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
// queryTaskData queryTaskStatus 的 data 列表项
|
|
|
|
|
|
type queryTaskData struct {
|
|
|
|
|
|
TaskCode string `json:"taskCode"`
|
|
|
|
|
|
TaskStatus string `json:"taskStatus"`
|
|
|
|
|
|
AgvCode string `json:"agvCode"`
|
|
|
|
|
|
TaskTyp string `json:"taskTyp"`
|
2026-09-04 14:18:53 +08:00
|
|
|
|
}
|
|
|
|
|
|
|
2026-10-17 17:49:47 +08:00
|
|
|
|
// QueryTask 实现 Client:查询任务状态(queryTaskStatus)。
|
2026-11-04 19:06:03 +08:00
|
|
|
|
// 按 taskCode 查询,返回匹配项的 taskStatus(数字字符串)与 RCS 分配的 agvCode;无匹配视为刚创建("1")。
|
|
|
|
|
|
func (c *realClient) QueryTask(ctx context.Context, taskCode string) (string, string, error) {
|
2026-10-17 17:49:47 +08:00
|
|
|
|
payload := map[string]any{
|
|
|
|
|
|
"agvCode": "",
|
|
|
|
|
|
"taskCodes": []string{taskCode},
|
|
|
|
|
|
}
|
|
|
|
|
|
var out struct {
|
|
|
|
|
|
Data []queryTaskData `json:"data"`
|
|
|
|
|
|
}
|
|
|
|
|
|
if err := c.call(ctx, "/queryTaskStatus", payload, &out); err != nil {
|
2026-11-04 19:06:03 +08:00
|
|
|
|
return "", "", err
|
2026-09-04 14:18:53 +08:00
|
|
|
|
}
|
2026-10-17 17:49:47 +08:00
|
|
|
|
for _, d := range out.Data {
|
|
|
|
|
|
if d.TaskCode == taskCode && d.TaskStatus != "" {
|
2026-11-04 19:06:03 +08:00
|
|
|
|
return d.TaskStatus, d.AgvCode, nil
|
2026-09-04 14:18:53 +08:00
|
|
|
|
}
|
|
|
|
|
|
}
|
2026-11-04 19:06:03 +08:00
|
|
|
|
return "1", "", nil
|
2026-09-04 14:18:53 +08:00
|
|
|
|
}
|
|
|
|
|
|
|
2026-10-17 17:49:47 +08:00
|
|
|
|
// CancelTask 实现 Client:取消任务(cancelTask,按 taskCode)。
|
|
|
|
|
|
func (c *realClient) CancelTask(ctx context.Context, taskCode, reason string) error {
|
|
|
|
|
|
if taskCode == "" {
|
|
|
|
|
|
return fmt.Errorf("缺少任务单号")
|
2026-09-17 19:41:00 +08:00
|
|
|
|
}
|
|
|
|
|
|
payload := map[string]any{
|
2026-10-17 17:49:47 +08:00
|
|
|
|
"taskCode": taskCode,
|
|
|
|
|
|
"forceCancel": "0", // 0=取消后货架放地上(默认)
|
2026-09-17 19:41:00 +08:00
|
|
|
|
}
|
2026-10-17 17:49:47 +08:00
|
|
|
|
_ = reason // RCS-Lite 取消任务接口无原因字段,原因仅落本地 agv_tasks.remark
|
|
|
|
|
|
return c.call(ctx, "/cancelTask", payload, nil)
|
2026-09-17 19:41:00 +08:00
|
|
|
|
}
|
|
|
|
|
|
|
2026-11-03 18:29:31 +08:00
|
|
|
|
// queryAgvStatusData 3.1.7 单条车辆状态 data 项
|
|
|
|
|
|
type queryAgvStatusData struct {
|
|
|
|
|
|
RobotCode string `json:"robotCode"`
|
|
|
|
|
|
Battery string `json:"battery"`
|
|
|
|
|
|
Status string `json:"status"`
|
|
|
|
|
|
PodCode string `json:"podCode"`
|
|
|
|
|
|
PosX string `json:"posX"`
|
|
|
|
|
|
PosY string `json:"posY"`
|
|
|
|
|
|
Stop string `json:"stop"`
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
// QueryAgvStatus 实现 Client:3.1.7 只读获取全部车辆状态。
|
|
|
|
|
|
// mapShortName 取配置 MapCode(多地图场景必填;单地图可空,RCS 侧默认)。
|
|
|
|
|
|
func (c *realClient) QueryAgvStatus(ctx context.Context) ([]AgvVehicle, error) {
|
|
|
|
|
|
payload := map[string]any{
|
|
|
|
|
|
"mapShortName": c.cfg.MapCode,
|
|
|
|
|
|
}
|
|
|
|
|
|
var out struct {
|
|
|
|
|
|
Data []queryAgvStatusData `json:"data"`
|
|
|
|
|
|
}
|
|
|
|
|
|
if err := c.call(ctx, "/queryAgvStatus", payload, &out); err != nil {
|
|
|
|
|
|
return nil, err
|
|
|
|
|
|
}
|
|
|
|
|
|
vs := make([]AgvVehicle, 0, len(out.Data))
|
|
|
|
|
|
for _, d := range out.Data {
|
|
|
|
|
|
vs = append(vs, AgvVehicle{
|
|
|
|
|
|
RobotCode: d.RobotCode,
|
|
|
|
|
|
Battery: atof(d.Battery),
|
|
|
|
|
|
Status: d.Status,
|
|
|
|
|
|
PodCode: d.PodCode,
|
|
|
|
|
|
PosX: atof(d.PosX),
|
|
|
|
|
|
PosY: atof(d.PosY),
|
|
|
|
|
|
Stop: d.Stop == "1",
|
|
|
|
|
|
})
|
|
|
|
|
|
}
|
|
|
|
|
|
return vs, nil
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
func atof(s string) float64 {
|
|
|
|
|
|
var v float64
|
|
|
|
|
|
fmt.Sscanf(s, "%f", &v)
|
|
|
|
|
|
return v
|
|
|
|
|
|
}
|
|
|
|
|
|
|
2026-09-17 19:41:00 +08:00
|
|
|
|
// Disable 真实客户端非 Mock 模式
|
|
|
|
|
|
func (c *realClient) Disable() bool { return false }
|
|
|
|
|
|
|
2026-09-04 14:18:53 +08:00
|
|
|
|
// ---------- Mock 客户端(未接真实 RCS 时用) ----------
|
|
|
|
|
|
|
|
|
|
|
|
type mockClient struct{}
|
|
|
|
|
|
|
|
|
|
|
|
func newMockClient() *mockClient { return &mockClient{} }
|
|
|
|
|
|
|
2026-10-17 17:49:47 +08:00
|
|
|
|
func (m *mockClient) SubmitTask(ctx context.Context, taskCode, fromDock, toDock, carrierCode string) (string, error) {
|
|
|
|
|
|
// 模拟立即成功下发,返回我方 taskCode(与真实客户端一致,HikTaskCode=taskNo)
|
|
|
|
|
|
return taskCode, nil
|
2026-09-04 14:18:53 +08:00
|
|
|
|
}
|
|
|
|
|
|
|
2026-11-04 19:06:03 +08:00
|
|
|
|
func (m *mockClient) QueryTask(ctx context.Context, taskCode string) (string, string, error) {
|
|
|
|
|
|
// 模拟:MOCK 任务一律视为已结束,便于离线联调观察"待搬运→已到位";模拟模式无真实分车,agvCode 为空
|
|
|
|
|
|
return "9", "", nil
|
2026-09-04 14:18:53 +08:00
|
|
|
|
}
|
|
|
|
|
|
|
2026-10-17 17:49:47 +08:00
|
|
|
|
func (m *mockClient) CancelTask(ctx context.Context, taskCode, reason string) error {
|
2026-09-17 19:41:00 +08:00
|
|
|
|
return nil
|
|
|
|
|
|
}
|
|
|
|
|
|
|
2026-11-03 18:29:31 +08:00
|
|
|
|
// QueryAgvStatus Mock:返回两台示例车(一台空闲、一台执行中),便于联调展示。
|
|
|
|
|
|
func (m *mockClient) QueryAgvStatus(ctx context.Context) ([]AgvVehicle, error) {
|
|
|
|
|
|
return []AgvVehicle{
|
|
|
|
|
|
{RobotCode: "9001", Battery: 99, Status: "4", PodCode: "0", PosX: 20000, PosY: 20000, Stop: false},
|
|
|
|
|
|
{RobotCode: "9002", Battery: 78, Status: "2", PodCode: "100001", PosX: 35000, PosY: 12000, Stop: false},
|
|
|
|
|
|
}, nil
|
|
|
|
|
|
}
|
|
|
|
|
|
|
2026-09-17 19:41:00 +08:00
|
|
|
|
func (m *mockClient) Disable() bool { return true }
|