From afbd08deb5101d2f2ff97f66f4388162f38860a2 Mon Sep 17 00:00:00 2001
From: luxiaotao1123 <t1341870251@163.com>
Date: 星期六, 17 八月 2024 11:21:55 +0800
Subject: [PATCH] #

---
 src/components/agv.jsx |   61 +++++++++++++++++++++++++-----
 1 files changed, 51 insertions(+), 10 deletions(-)

diff --git a/src/components/agv.jsx b/src/components/agv.jsx
index 6ecf7a0..73e1d51 100644
--- a/src/components/agv.jsx
+++ b/src/components/agv.jsx
@@ -5,6 +5,7 @@
 import Box from './box';
 import * as Common from '../utils/common';
 import * as TWEEN from "@tweenjs/tween.js";
+import { useStore } from '@/store';
 import {
     INTERVAL_TIME,
     MODEL_AGV_SCALE,
@@ -127,8 +128,41 @@
     }
 }
 
+const getMajorPos = (position, bodyAngle, offset) => {
+    const majorAngle = Common.positiveAngle(bodyAngle);
+    // console.log(position, majorAngle, offset);
+    if (majorAngle > 360 - 10 || majorAngle < 0 + 10) {
+        return {
+            x: (position?.[2] + offset) * REAL_COMPARE_MAP_SCALE + REAL_COMPARE_MAP_OFFSET_X,
+            y: position?.[1] * REAL_COMPARE_MAP_SCALE,
+            z: position?.[0] * REAL_COMPARE_MAP_SCALE + REAL_COMPARE_MAP_OFFSET_Z,
+        }
+    }
+    if (majorAngle > 180 - 10 && majorAngle < 180 + 10) {
+        return {
+            x: (position?.[2] - offset) * REAL_COMPARE_MAP_SCALE + REAL_COMPARE_MAP_OFFSET_X,
+            y: position?.[1] * REAL_COMPARE_MAP_SCALE,
+            z: position?.[0] * REAL_COMPARE_MAP_SCALE + REAL_COMPARE_MAP_OFFSET_Z,
+        }
+    }
+    if (majorAngle > 90 - 10 && majorAngle < 90 + 10) {
+        return {
+            x: position?.[2] * REAL_COMPARE_MAP_SCALE + REAL_COMPARE_MAP_OFFSET_X,
+            y: position?.[1] * REAL_COMPARE_MAP_SCALE,
+            z: (position?.[0] - offset) * REAL_COMPARE_MAP_SCALE + REAL_COMPARE_MAP_OFFSET_Z,
+        }
+    }
+    if (majorAngle > 270 - 10 && majorAngle < 270 + 10) {
+        return {
+            x: position?.[2] * REAL_COMPARE_MAP_SCALE + REAL_COMPARE_MAP_OFFSET_X,
+            y: position?.[1] * REAL_COMPARE_MAP_SCALE,
+            z: (position?.[0] + offset) * REAL_COMPARE_MAP_SCALE + REAL_COMPARE_MAP_OFFSET_Z,
+        }
+    }
+}
+
 const Agv = (props) => {
-    const { agvNo, position, trayList, hasBox, finger1, finger2, finger3, finger4, inOutFlag } = props;
+    const { agvNo, position, trayList, hasBox, finger1, finger2, finger3, finger4, inOutFlag, offset } = props;
     const theta = -props.theta;
     const height = props.height * 0.0655;
 
@@ -138,20 +172,28 @@
     const [loaderAngle, setLoaderAngle] = useState(0);
     const [forkDis, setForkDis] = useState(0);
     const [realTrayList, setRealTrayList] = useState([]);
+    const store = useStore();
+
+    useEffect(() => {
+        if (store.autoCruise && agvNo === store.cruiseAgvNo) {
+            // store.lookAt = groupPos;
+
+            store.lookAt.x = groupPos.x;
+            store.lookAt.y = loaderHeight;
+            store.lookAt.z = groupPos.z;
+        }
+    }, [groupPos, loaderHeight])
 
     useEffect(() => {
         if (!props || Object.keys(props).length === 0) {
             return;
         }
 
-        console.log(props.taskShelfBarcode);
-
+        // group theta
+        const targetTheta = Common.normalizeAngle(theta - groupTheta) + groupTheta;
         // group position
-        const pos = {
-            x: position?.[2] * REAL_COMPARE_MAP_SCALE + REAL_COMPARE_MAP_OFFSET_X,
-            y: position?.[1] * REAL_COMPARE_MAP_SCALE,
-            z: position?.[0] * REAL_COMPARE_MAP_SCALE + REAL_COMPARE_MAP_OFFSET_Z,
-        }
+        const pos = getMajorPos(position, targetTheta, offset);
+
         if (!Common.deepEqual(groupPos, pos) && props.position !== null) {
             new TWEEN.Tween(groupPos)
                 .to(pos, INTERVAL_TIME)
@@ -166,7 +208,6 @@
 
         // group theta
         if (groupTheta !== theta && props.theta !== null) {
-            const targetTheta = Common.normalizeAngle(theta - groupTheta) + groupTheta;
             new TWEEN.Tween({ value: groupTheta })
                 .to({ value: targetTheta }, INTERVAL_TIME)
                 .easing(TWEEN.Easing.Linear.None)
@@ -179,7 +220,7 @@
         }
 
         // loader height
-        if (loaderHeight !== height && props.height !== null) {
+        if (loaderHeight !== height && props.height !== null && props.height > 1) {
             new TWEEN.Tween({ value: loaderHeight })
                 .to({ value: height }, INTERVAL_TIME)
                 .easing(TWEEN.Easing.Linear.None)

--
Gitblit v1.9.1