AGV 调度: - 任务重构为 GO_LOAD/TRANSPORT/EMPTY_RETURN/FREE 三段链,到位即停(ARRIVED)需人工确认装卸 - 自由调度单点步进,每段强制弹"请确保路径畅通无杂物";托盘回收独立工作台 - 接驳台 PLC 传感器检测到托盘即自动卸货放行,传感器故障由人工按钮兜底(无轮询) - 车辆状态只读展示(海康3.1.7 queryAgvStatus),调度仍由 RCS 负责 物料闭环: - 补料管理(SHORTAGE):工位申请 + 主管审批调增叫料池额度,与借料/差异补发三轨并行 - 损耗台账(loss_ledger):退料实际 < 理论必填原因、后审核,工单不记损耗 - 退料强制指定左/右接驳台,WMS 库管可代工位退料 下班闭环: - 工位终端自检接驳台剩余物料后下班;库管收货 + 托盘拉走后事件驱动自动结班 - 退出登录未下班仅作安全提示(不强制拦截、不新增责任审批) 接驳台左右按操作员朝向建模(dock.side 字段),废除"奇左偶右"隐式约定; 看板标签 / seed / 迁移补丁 / 布局文档统一为中文左/右。 产线布局说明:C1 前线头 AGV 点、C15 后线尾 AGV 点、外部 O1/O2/O3 散点, 清理修订痕迹为最终态描述。
284 lines
9.6 KiB
Go
284 lines
9.6 KiB
Go
// 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 客户端。
|
||
package agv
|
||
|
||
import (
|
||
"bytes"
|
||
"context"
|
||
"encoding/json"
|
||
"fmt"
|
||
"io"
|
||
"net/http"
|
||
"strings"
|
||
"time"
|
||
|
||
"github.com/google/uuid"
|
||
|
||
"bj_power_mes/internal/config"
|
||
)
|
||
|
||
// Client AGV 调度客户端抽象
|
||
type Client interface {
|
||
// SubmitTask 下发搬运任务 fromDock -> toDock。taskCode 为我方任务单号(透传给 RCS 便于回查)。
|
||
// 成功返回该 taskCode(RCS-Lite 不下发明文任务码,以我方 taskCode 为唯一追踪键)。
|
||
SubmitTask(ctx context.Context, taskCode, fromDock, toDock, carrierCode string) (string, error)
|
||
// QueryTask 查询任务状态,返回 RCS 数字状态:"1"已创建/"2"执行中/"5"取消完成/"9"已结束。
|
||
QueryTask(ctx context.Context, taskCode string) (string, error)
|
||
// CancelTask 取消任务(按 taskCode)。
|
||
CancelTask(ctx context.Context, taskCode, reason string) error
|
||
// QueryAgvStatus 只读获取车辆状态(3.1.7 queryAgvStatus):车辆闲忙/充电/电量/位置。
|
||
// 纯只读展示,不参与调度(调度完全交给 RCS 自身)。
|
||
QueryAgvStatus(ctx context.Context) ([]AgvVehicle, error)
|
||
// Disable 是否处于 Mock(未接真实 RCS)模式。
|
||
Disable() bool
|
||
}
|
||
|
||
// 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"` // 是否暂停
|
||
}
|
||
|
||
// New 依据配置返回真实或 Mock 客户端
|
||
func New(cfg config.AgvConf) Client {
|
||
if cfg.EnableMock || cfg.BaseURL == "" {
|
||
return newMockClient()
|
||
}
|
||
return newRealClient(cfg)
|
||
}
|
||
|
||
// ---------- 请求与响应(真实海康 RCS-Lite) ----------
|
||
|
||
type realClient struct {
|
||
cfg config.AgvConf
|
||
hc *http.Client
|
||
carrier string
|
||
}
|
||
|
||
func newRealClient(cfg config.AgvConf) *realClient {
|
||
return &realClient{
|
||
cfg: cfg,
|
||
hc: &http.Client{Timeout: 15 * time.Second},
|
||
carrier: cfg.CarrierCode,
|
||
}
|
||
}
|
||
|
||
// url 拼接 RCS-Lite 基础地址 + 业务路径(BaseURL 已含 /rCMS/services/rest/hikRpcService)。
|
||
func (c *realClient) url(path string) string {
|
||
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"`
|
||
}
|
||
|
||
// 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")
|
||
|
||
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
|
||
}
|
||
req.Header.Set("Content-Type", "application/json;charset=UTF-8")
|
||
|
||
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))
|
||
}
|
||
var env envelope
|
||
if err := json.Unmarshal(raw, &env); err != nil {
|
||
return fmt.Errorf("agv parse envelope: %w", err)
|
||
}
|
||
// 成功码固定字符串 "0"(§1.5 结果码定义)
|
||
if env.Code != "0" {
|
||
return fmt.Errorf("agv code=%s message=%s", env.Code, env.Message)
|
||
}
|
||
if out != nil && len(env.Data) > 0 {
|
||
return json.Unmarshal(env.Data, out)
|
||
}
|
||
return nil
|
||
}
|
||
|
||
// SubmitTask 实现 Client:生成搬运任务(genAgvSchedulingTask)。
|
||
// 两点搬运:源点(fromDock) → 目标点(toDock) 用 positionCodePath 两个点(type=00 位置编号)表达。
|
||
// 空车段(fromDock 为空,2026-11-03 三段链模型):仅下发目标点单点 path,由 RCS 派最近空闲车前往——
|
||
// 对应「业务自动触发免弹窗」的空车去程(AGV 空车前往装货点);若现场 RCS 要求两点 path,联调时改为 [充电位, 装货点]。
|
||
// 任务类型固定 F01(厂内货架搬运);taskCode 透传我方任务单号。
|
||
func (c *realClient) SubmitTask(ctx context.Context, taskCode, fromDock, toDock, carrierCode string) (string, error) {
|
||
path := []map[string]any{
|
||
{"positionCode": toDock, "type": "00"},
|
||
}
|
||
if fromDock != "" {
|
||
path = []map[string]any{
|
||
{"positionCode": fromDock, "type": "00"},
|
||
{"positionCode": toDock, "type": "00"},
|
||
}
|
||
}
|
||
payload := map[string]any{
|
||
"taskTyp": "F01",
|
||
"positionCodePath": path,
|
||
"priority": c.cfg.Priority,
|
||
"taskCode": taskCode,
|
||
}
|
||
carrier := carrierCode
|
||
if carrier == "" {
|
||
carrier = c.carrier
|
||
}
|
||
if carrier != "" {
|
||
payload["podCode"] = carrier // 载具/托盘编号(选填)
|
||
}
|
||
if err := c.call(ctx, "/genAgvSchedulingTask", payload, nil); err != nil {
|
||
return "", err
|
||
}
|
||
// 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"`
|
||
}
|
||
|
||
// QueryTask 实现 Client:查询任务状态(queryTaskStatus)。
|
||
// 按 taskCode 查询,返回匹配项的 taskStatus(数字字符串);无匹配视为刚创建("1")。
|
||
func (c *realClient) QueryTask(ctx context.Context, taskCode string) (string, error) {
|
||
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 {
|
||
return "", err
|
||
}
|
||
for _, d := range out.Data {
|
||
if d.TaskCode == taskCode && d.TaskStatus != "" {
|
||
return d.TaskStatus, nil
|
||
}
|
||
}
|
||
return "1", nil
|
||
}
|
||
|
||
// CancelTask 实现 Client:取消任务(cancelTask,按 taskCode)。
|
||
func (c *realClient) CancelTask(ctx context.Context, taskCode, reason string) error {
|
||
if taskCode == "" {
|
||
return fmt.Errorf("缺少任务单号")
|
||
}
|
||
payload := map[string]any{
|
||
"taskCode": taskCode,
|
||
"forceCancel": "0", // 0=取消后货架放地上(默认)
|
||
}
|
||
_ = reason // RCS-Lite 取消任务接口无原因字段,原因仅落本地 agv_tasks.remark
|
||
return c.call(ctx, "/cancelTask", payload, nil)
|
||
}
|
||
|
||
// 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
|
||
}
|
||
|
||
// Disable 真实客户端非 Mock 模式
|
||
func (c *realClient) Disable() bool { return false }
|
||
|
||
// ---------- Mock 客户端(未接真实 RCS 时用) ----------
|
||
|
||
type mockClient struct{}
|
||
|
||
func newMockClient() *mockClient { return &mockClient{} }
|
||
|
||
func (m *mockClient) SubmitTask(ctx context.Context, taskCode, fromDock, toDock, carrierCode string) (string, error) {
|
||
// 模拟立即成功下发,返回我方 taskCode(与真实客户端一致,HikTaskCode=taskNo)
|
||
return taskCode, nil
|
||
}
|
||
|
||
func (m *mockClient) QueryTask(ctx context.Context, taskCode string) (string, error) {
|
||
// 模拟:MOCK 任务一律视为已结束,便于离线联调观察"待搬运→已到位"
|
||
return "9", nil
|
||
}
|
||
|
||
func (m *mockClient) CancelTask(ctx context.Context, taskCode, reason string) error {
|
||
return nil
|
||
}
|
||
|
||
// 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
|
||
}
|
||
|
||
func (m *mockClient) Disable() bool { return true }
|