#

luxiaotao1123

2024-05-15 3f41ad8cf82b08585e89815feadb5a17938b3033

 src/components/agv.jsx

@@ -1,62 +1,288 @@
import { useRef, useEffect } from 'react';
import { useState, useMemo, useRef, useEffect } from 'react';
import { useFrame } from '@react-three/fiber';
import { useFBX, useAnimations } from '@react-three/drei';
import { AnimationMixer } from 'three';
import * as THREE from 'three';
import Box from './box';
import * as Common from '../utils/common';
import * as TWEEN from "@tweenjs/tween.js";
import {
    INTERVAL_TIME,
    MODEL_AGV_SCALE,
    REAL_COMPARE_MAP_SCALE,
    REAL_COMPARE_MAP_OFFSET_X,
    REAL_COMPARE_MAP_OFFSET_Z,
} from '../config/setting'

const getCorrectForkDis = (loaderAngle, forkDis) => {
    if (loaderAngle > 360 - 10 || loaderAngle < 0 + 10) {
        return -forkDis;
    }
    if (loaderAngle > 180 - 10 && loaderAngle < 180 + 10) {
        return -forkDis;
    }
    if (loaderAngle > 90 - 10 && loaderAngle < 90 + 10) {
        return forkDis;
    }
    if (loaderAngle > 270 - 10 && loaderAngle < 270 + 10) {
        return forkDis;
    }
    return forkDis;
}

const getLoaderHasBox = (loaderAngle, inOutFlag, finger1, finger2, finger3, finger4) => {
    // console.log(loaderAngle, forkDis, finger1, finger2, finger3, finger4);
    if (loaderAngle > 360 - 10 || loaderAngle < 0 + 10) {
        if (inOutFlag === 1) {
            return finger1 && finger2;
        }
        if (inOutFlag === 2) {
            return finger3 && finger4;
        }
        return finger1 && finger2;  // 取货是对的 放货是错的 （右）
        /**
         * 2排 (0)
         * 
         * 取货 
         * 0 false false false false
         * 0 false false true true
         * 0 true true true true
         * 
         * 放货
         * 0 true true true true
         * 0 false false true true
         * 0 false false false false
         * 
         */
    }
    if (loaderAngle > 180 - 10 && loaderAngle < 180 + 10) {
        if (inOutFlag === 1) {
            return finger1 && finger2;
        }
        if (inOutFlag === 2) {
            return finger3 && finger4;
        }
        return finger3 && finger4;  // 放货是对的   取货是错的 （左）
        /**
         * 1、3排 (180)
         * 
         * 取货 
         * 180 false false false false
         * 180 false false true true
         * 180 true true true true
         * 
         * 放货
         * 180 false false true true
         * 180 false false false false
         * 
         */
    }
    if (loaderAngle > 90 - 10 && loaderAngle < 90 + 10) {
        if (inOutFlag === 3) {
            return finger3 && finger4;
        }
        if (inOutFlag === 4) {
            return finger1 && finger2;
        }
        return finger1 && finger2;  // 放货是对的 取货是错的 （中）
        /**
         * 背篓 (90)
         * 
         * 取货
         * 90 true true false false
         * 90 true true true true
         * 
         * 放货
         * 90 true true true true
         * 90 true true false false
         * 90 false false false false
         * 
         */
    }
    if (loaderAngle > 270 - 10 && loaderAngle < 270 + 10) {
        return finger1 && finger2;
    }
    return finger1 && finger2 && finger3 && finger4;
}

const forkLengthFn = (forkLen, loaderAngle) => {
    let maxVal = 800;
    if (loaderAngle > 360 - 10 || loaderAngle < 0 + 10) {
        maxVal = 1100;
    }
    if (loaderAngle > 180 - 10 && loaderAngle < 180 + 10) {
        maxVal = 1100;
    }
    if (loaderAngle > 90 - 10 && loaderAngle < 90 + 10) {
        maxVal = 800;
    }
    if (loaderAngle > 270 - 10 && loaderAngle < 270 + 10) {
        maxVal = 0;
    }
    if (forkLen < 0) {
        return -maxVal * 0.077;
    } else if (forkLen > 0) {
        return maxVal * 0.077;
    } else {
        return 0;
    }
}

const Agv = (props) => {
    const fbxRef = useRef();
    const mixerRef = useRef();
    const { agvNo, position, trayList, hasBox, finger1, finger2, finger3, finger4, inOutFlag } = props;
    const theta = -props.theta;
    const height = props.height * 0.0655;

    const fbx = useFBX('/models/agv/body.fbx');

    const setShadow = (obj) => {
        obj.castShadow = true;
        obj.receiveShadow = true;

        if (obj.children) {
            obj.children.forEach((child) => {
                setShadow(child);
            });
        }
    };

    const setColor = (obj) => {
        if (obj.material) {
            obj.material.color.set(0x4680BF);
        }
        if (obj.children) {
            obj.children.forEach((child) => {
                setColor(child);
            });
        }
    };

    // setColor(fbx)
    if (!fbx.castShadow) {
        setShadow(fbx);
    }
    const [groupPos, setGroupPos] = useState({ x: 0, y: 0, z: 0 });
    const [groupTheta, setGroupTheta] = useState(0);
    const [loaderHeight, setLoaderHeight] = useState(0);
    const [loaderAngle, setLoaderAngle] = useState(0);
    const [forkDis, setForkDis] = useState(0);
    const [realTrayList, setRealTrayList] = useState([]);

    useEffect(() => {
        mixerRef.current = new AnimationMixer(fbx);

        if (fbx.animations.length > 0) {
            useFrame((state, delta) => {
                mixerRef?.current?.update(delta);
            });

            const action = mixerRef.current.clipAction(fbx.animations[0]); // 假设只有一个动画，可以根据实际情况修改
            action.play();
        if (!props || Object.keys(props).length === 0) {
            return;
        }

        return () => {
            mixerRef.current.stopAllAction();
        };
    }, []);
        console.log(props.taskShelfBarcode);

        // 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,
        }
        if (!Common.deepEqual(groupPos, pos) && props.position !== null) {
            new TWEEN.Tween(groupPos)
                .to(pos, INTERVAL_TIME)
                .easing(TWEEN.Easing.Linear.None)
                .onUpdate((e) => {
                    setGroupPos({ ...e });
                })
                .onComplete((e) => {
                    setGroupPos({ ...e });
                }).start();
        }

        // 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)
                .onUpdate((e) => {
                    setGroupTheta(e.value)
                })
                .onComplete((e) => {
                    setGroupTheta(e.value)
                }).start();
        }

        // loader height
        if (loaderHeight !== height && props.height !== null) {
            new TWEEN.Tween({ value: loaderHeight })
                .to({ value: height }, INTERVAL_TIME)
                .easing(TWEEN.Easing.Linear.None)
                .onUpdate((e) => {
                    setLoaderHeight(e.value)
                })
                .onComplete((e) => {
                    setLoaderHeight(e.value)
                }).start();
        }

        // loader theta
        const loaderTargetTheta = Common.normalizeAngle(Number(props.loaderTheta?.toFixed(1)) + 90);
        if (loaderAngle !== loaderTargetTheta && props.loaderTheta !== null) {
            new TWEEN.Tween({ value: loaderAngle })
                .to({ value: loaderTargetTheta }, INTERVAL_TIME)
                .easing(TWEEN.Easing.Linear.None)
                .onUpdate((e) => {
                    setLoaderAngle(e.value)
                })
                .onComplete((e) => {
                    setLoaderAngle(e.value)
                }).start();
        }

        // fork lenght
        const forkLength = props.forkLength * 0.077;
        // const forkLength = forkLengthFn(props.forkLength, loaderTargetTheta);
        if (forkDis !== forkLength && props.forkLength !== null) {
            const targetForkDis = getCorrectForkDis(Common.positiveAngle(loaderTargetTheta), forkLength);
            new TWEEN.Tween({ value: forkDis })
                .to({ value: targetForkDis }, INTERVAL_TIME)
                .easing(TWEEN.Easing.Linear.None)
                .onUpdate((e) => {
                    setForkDis(e.value)
                })
                .onComplete((e) => {
                    setForkDis(e.value)
                }).start();
        }

        if (trayList) {
            setRealTrayList(trayList);
        }

    }, [props]);

    useFrame((state, delta) => {
        TWEEN.update();
    })

    const bodyModel = useMemo(() => {
        const fbx = useFBX('/models/agv/body.fbx');
        if (!fbx.castShadow) {
            Common.setShadow(fbx);
        }
        fbx.scale.set(MODEL_AGV_SCALE, MODEL_AGV_SCALE * 0.97, MODEL_AGV_SCALE);
        return fbx.clone();
    }, [])

    const loaderModel = useMemo(() => {
        const fbx = useFBX('/models/agv/loader.fbx');
        if (!fbx.castShadow) {
            Common.setShadow(fbx);
        }
        fbx.scale.set(MODEL_AGV_SCALE, MODEL_AGV_SCALE, MODEL_AGV_SCALE);
        return fbx.clone();
    }, [])

    const forkModel = useMemo(() => {
        const fbx = useFBX('/models/agv/fork.fbx');
        if (!fbx.castShadow) {
            Common.setShadow(fbx);
        }
        fbx.scale.set(MODEL_AGV_SCALE, MODEL_AGV_SCALE, MODEL_AGV_SCALE);
        return fbx.clone();
    }, [])

    return (
        <>
            <group rotation={[0, 0, 0]} scale={0.5} position={[0, 0, 0]}>
                <primitive object={fbx} castShadow />
            <group
                rotation-y={Common.rotationParseNum(groupTheta)}
                position={[groupPos.x, groupPos.y, groupPos.z]}
            >
                <primitive object={bodyModel} castShadow />
                <group
                    position-y={loaderHeight}
                    rotation-y={Common.rotationParseNum(loaderAngle)}
                >
                    <primitive object={loaderModel} castShadow position={[0, 0, 0]} />
                    <group position-z={forkDis}>
                        <primitive object={forkModel} castShadow position={[0, 6, 0]} />
                        {(hasBox || getLoaderHasBox(loaderAngle, inOutFlag, finger1, finger2, finger3, finger4)) && <Box position={[0, 6, 0]} />}
                    </group>
                </group>
                <group>
                    {realTrayList?.[0]?.hasBox && <Box rotationY={Math.PI / 2} position={[-60, 34, 0]} />}
                    {realTrayList?.[1]?.hasBox && <Box rotationY={Math.PI / 2} position={[-60, 66, 0]} />}
                    {realTrayList?.[2]?.hasBox && <Box rotationY={Math.PI / 2} position={[-60, 99, 0]} />}
                    {realTrayList?.[3]?.hasBox && <Box rotationY={Math.PI / 2} position={[-60, 131, 0]} />}
                    {realTrayList?.[4]?.hasBox && <Box rotationY={Math.PI / 2} position={[-60, 163, 0]} />}
                    {realTrayList?.[5]?.hasBox && <Box rotationY={Math.PI / 2} position={[-60, 195, 0]} />}
                </group>
            </group>
        </>
    )