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