自动化立体仓库 - WCS系统
blame | 历史 | 补丁 | 提交 | 提交对比 | ignore whitespace
#
luxiaotao1123
2021-01-04 718dd839d68cea067b554624b044c1a2be30659e 
 src/main/java/com/zy/core/thread/SiemensDevpThread.java


@@ -5,6 +5,7 @@


import HslCommunication.Profinet.Siemens.SiemensPLCS;


import HslCommunication.Profinet.Siemens.SiemensS7Net;


import com.alibaba.fastjson.JSON;


import com.core.common.Arith;


import com.core.common.DateUtils;


import com.core.common.SpringUtils;


import com.zy.asrs.entity.BasDevp;


@@ -38,6 +39,22 @@


    private SiemensS7Net siemensS7Net;


    private Map<Integer, StaProtocol> station = new ConcurrentHashMap<>();


    private short heartBeatVal = 1;


    public static final ArrayList<Integer> staNos = new ArrayList<Integer>() {{


        add(100);add(101);add(102);add(103);add(104);add(105);add(106);add(107);add(108);add(109);add(110);add(111);add(112);add(113);add(114);add(115);add(116);add(117);


        add(118);add(119);add(120);add(121);add(122);add(123);add(124);add(125);add(126);add(127);add(128);


        add(200);add(201);add(202);add(203);add(204);add(205);


    }};




    public static void main(String[] args) {


        for (Integer siteId : staNos) {


            int divides = (int) Arith.divides(0, siteId, 100);


            int remainder = (int) Arith.remainder(siteId, 100);


            int index = ((divides - 1) * 50) + remainder;


//            System.out.print(siteId + " 任务地址 ： " + index*2);


//            System.out.print(" 目标地址 ： " + (index*2+200) );


            System.out.println(siteId + " 状态 ： " + (index*2) );


        }


    }




    public SiemensDevpThread(DevpSlave slave) {


        this.slave = slave;


@@ -100,44 +117,46 @@


     * 读取状态 ====> 整块plc


     */


    private void read() throws InterruptedException {


        OperateResultExOne<byte[]> result = siemensS7Net.Read("DB100.0", (short) 40);


        OperateResultExOne<byte[]> result = siemensS7Net.Read("DB100.0", (short) 350);


        if (result.IsSuccess) {


            for (int i = 1; i <= 8; i++) {


                StaProtocol staProtocol = station.get(i);


            for (int i = 0; i < staNos.size(); i++) {


                Integer siteId = staNos.get(i); // 站点编号


                StaProtocol staProtocol = station.get(siteId);


                if (null == staProtocol) {


                    staProtocol = new StaProtocol();


                    staProtocol.setSiteId(i);


                    station.put(i, staProtocol);


                    staProtocol.setSiteId(siteId);


                    station.put(siteId, staProtocol);


                }


                staProtocol.setWorkNo(siemensS7Net.getByteTransform().TransInt16(result.Content, (i-1)*2));     // 工作号


                staProtocol.setStaNo(siemensS7Net.getByteTransform().TransInt16(result.Content, (i-1)*2+20));   // 目标站


                int divides = (int) Arith.divides(0, siteId, 100);


                int remainder = (int) Arith.remainder(siteId, 100);


                int index = ((divides - 1) * 50) + remainder;


                staProtocol.setWorkNo(siemensS7Net.getByteTransform().TransInt16(result.Content, index*2));     // 工作号


                staProtocol.setStaNo(siemensS7Net.getByteTransform().TransInt16(result.Content, index*2 + 200));   // 目标站


            }


        }


        Thread.sleep(100);


        OperateResultExOne<byte[]> result1 = siemensS7Net.Read("DB100.40", (short) 8);


        OperateResultExOne<byte[]> result1 = siemensS7Net.Read("DB100.500", (short) 106);


        if (result1.IsSuccess) {


            for (int i = 1; i <= 8; i++) {


                boolean[] status = siemensS7Net.getByteTransform().TransBool(result1.Content, i-1, 1);


                StaProtocol staProtocol = station.get(i);


            for (int i = 0; i < staNos.size(); i++) {


                Integer siteId = staNos.get(i); // 站点编号


                int divides = (int) Arith.divides(0, siteId, 100);


                int remainder = (int) Arith.remainder(siteId, 100);


                int index = ((divides - 1) * 100) + remainder;


                boolean[] status = siemensS7Net.getByteTransform().TransBool(result1.Content, index, 1);


                StaProtocol staProtocol = station.get(siteId);


                staProtocol.setAutoing(status[0]);  // 自动


                staProtocol.setLoading(status[1]);  // 有物


                staProtocol.setInEnable(status[2]); // 可入


                staProtocol.setOutEnable(status[3]);// 可出


                staProtocol.setEmptyMk(status[4]);  // 空板信号


                staProtocol.setFullPlt(status[5]);  // 满托盘


                staProtocol.setHigh(status[6]);     // 高库位


                staProtocol.setLow(status[7]);      // 低库位




                if (!staProtocol.isPakMk() && !staProtocol.isLoading()) {


                    staProtocol.setPakMk(true);


                }


            }


        }


        // 台车位置


        OperateResultExOne<Short> result2 = siemensS7Net.ReadInt16("DB100.48");


        if (result2.IsSuccess) {


            StaProtocol staProtocol = station.get(8);


            staProtocol.setPosition(result2.Content);


        } else {


            OutputQueue.DEVP.offer(MessageFormat.format("【{0}】8号台车获取实时位置失败！！！", DateUtils.convert(new Date())));


            log.error("8号台车获取实时位置失败！！！");


        }




        if (result.IsSuccess && result1.IsSuccess) {


@@ -147,8 +166,8 @@


            // 根据实时信息更新数据库


            try {


                List<BasDevp> basDevps = new ArrayList<>();


                for (int i = 1; i <= 8; i++) {


                    StaProtocol staProtocol = station.get(i);


                for (Integer siteId : staNos) {


                    StaProtocol staProtocol = station.get(siteId);


                    basDevps.add(staProtocol.toSqlModel());


                }


                BasDevpService basDevpService = SpringUtils.getBean(BasDevpService.class);


@@ -173,16 +192,13 @@


        if (null == staProtocol) {


            return;


        }


        OperateResult write = siemensS7Net.Write("DB100." + (staProtocol.getSiteId() - 1) * 2, staProtocol.getWorkNo());    // 工作号


        int divides = (int) Arith.divides(0, staProtocol.getSiteId(), 100);


        int remainder = (int) Arith.remainder(staProtocol.getSiteId(), 100);


        int index = ((divides - 1) * 50) + remainder;




        OperateResult write = siemensS7Net.Write("DB100." + index*2, staProtocol.getWorkNo());    // 工作号


        Thread.sleep(300);


        OperateResult write1 = siemensS7Net.Write("DB100." + ((staProtocol.getSiteId() - 1) * 2 + 20), staProtocol.getStaNo());    // 目标站


//        boolean[] status = new boolean[8];


//        status[0] = staProtocol.isAutoing();


//        status[1] = staProtocol.isLoading();


//        status[2] = staProtocol.isInEnable();


//        status[3] = staProtocol.isOutEnable();


//        status[4] = staProtocol.isEmptyMk();


//        OperateResult write2 = siemensS7Net.Write("DB100." + ((staProtocol.getSiteId() - 1) + 40), status);     //  状态


        OperateResult write1 = siemensS7Net.Write("DB100." + (index*2 + 200), staProtocol.getStaNo());    // 目标站


        if (!write.IsSuccess || !write1.IsSuccess) {


            staProtocol = station.get(staProtocol.getSiteId());


            if (staProtocol.getWorkNo() == 0 && staProtocol.getStaNo() ==0) {


@@ -227,25 +243,25 @@


        siemensS7Net.ConnectClose();


    }




    public static void main(String[] args) throws Exception {


        DevpSlave slave = new DevpSlave();


        slave.setIp("192.168.2.125");


        SiemensDevpThread devpThread = new SiemensDevpThread(slave);


        devpThread.connect();


        devpThread.read();


        // 写


        StaProtocol staProtocol = devpThread.getStation().get(1);


        staProtocol.setWorkNo((short) 232);


        staProtocol.setStaNo((short) 6);


        staProtocol.setAutoing(true);


        staProtocol.setEmptyMk(true);


        staProtocol.setInEnable(true);


        devpThread.write(staProtocol);


        System.out.println("----------------------------------------");


        // 读


        devpThread.read();


        System.out.println(JSON.toJSONString(devpThread.station));




    }


//    public static void main(String[] args) throws Exception {


//        DevpSlave slave = new DevpSlave();


//        slave.setIp("192.168.2.125");


//        SiemensDevpThread devpThread = new SiemensDevpThread(slave);


//        devpThread.connect();


//        devpThread.read();


//        // 写


//        StaProtocol staProtocol = devpThread.getStation().get(1);


//        staProtocol.setWorkNo((short) 232);


//        staProtocol.setStaNo((short) 6);


//        staProtocol.setAutoing(true);


//        staProtocol.setEmptyMk(true);


//        staProtocol.setInEnable(true);


//        devpThread.write(staProtocol);


//        System.out.println("----------------------------------------");


//        // 读


//        devpThread.read();


//        System.out.println(JSON.toJSONString(devpThread.station));


//


//    }




}