whyclxw
2021-01-05 3eb8b438f1b5d6ffd8c13ce72b12f07a7a1dd6ed
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
package com.intelligt.modbus.jlibmodbus.serial;
 
import java.io.IOException;
import java.util.concurrent.LinkedBlockingDeque;
import java.util.concurrent.TimeUnit;
 
/*
 * Copyright (C) 2017 "Invertor" Factory", JSC
 * [http://www.sbp-invertor.ru]
 *
 * This file is part of JLibModbus.
 *
 * Licensed under the Apache License, Version 2.0 (the "License");
 * you may not use this file except in compliance with the License.
 * You may obtain a copy of the License at
 *
 *  http://www.apache.org/licenses/LICENSE-2.0
 *
 * Unless required by applicable law or agreed to in writing, software
 * distributed under the License is distributed on an "AS IS" BASIS,
 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
 * See the License for the specific language governing permissions and
 * limitations under the License.
 *
 * Authors: Kevin Kieffer.
 * email: <kkieffer@adaptivemethods.com>
 */
 
/**
 * @author Kevin Kieffer
 * @since 1.9.0
 */
public class SerialPortLoopback extends SerialPort {
 
    //This must be static to be used by all class instances
    private static final LinkedBlockingDeque<Byte> tx_from_master_fifo = new LinkedBlockingDeque<Byte>(8192);
    private static final LinkedBlockingDeque<Byte> rx_to_master_fifo = new LinkedBlockingDeque<Byte>(8192);
    private final LinkedBlockingDeque<Byte> myWriteFifo;
    private final LinkedBlockingDeque<Byte> myReadFifo;
    private boolean isOpen = false;
 
    public SerialPortLoopback(SerialParameters sp, boolean isMaster) throws SerialPortException {
        super(sp);
        if (isMaster) {
            myWriteFifo = tx_from_master_fifo;
            myReadFifo = rx_to_master_fifo;
        } else {
            myWriteFifo = rx_to_master_fifo;
            myReadFifo = tx_from_master_fifo;
        }
    }
 
    @Override
    public void write(int b) throws IOException {
        if (!myWriteFifo.offer((byte) b))
            throw new IOException("Loopback fifo full");
    }
 
    @Override
    public void write(byte[] bytes) throws IOException {
        if (!isOpen)
            throw new IOException("Loopback is not open");
        for (Byte b : bytes) {
            if (!myWriteFifo.offer(b))
                throw new IOException("Loopback fifo is full");
        }
    }
 
    @Override
    public void open() throws SerialPortException {
        isOpen = true;
    }
 
    @Override
    public int read() throws IOException {
        if (!isOpen)
            throw new IOException("Loopback is not open");
 
        try {
 
            Byte b = myReadFifo.poll((long) getReadTimeout(), TimeUnit.MILLISECONDS);
            if (b == null)
                throw new IOException("Timeout");
 
            return (int) b & 0xff;
 
        } catch (InterruptedException ex) {
            throw new IOException(ex);
        }
    }
 
    @Override
    public int read(byte[] b, int off, int len) throws IOException {
 
        int count = 0;
        for (int i = 0; i < len; i++) {
            try {
                Byte y = myReadFifo.poll((long) getReadTimeout(), TimeUnit.MILLISECONDS);
                if (y == null)
                    break;
                b[i + off] = y;
                count++;
 
            } catch (InterruptedException ex) {
                throw new IOException(ex);
            }
        }
        if (count == 0)
            throw new IOException("Timeout");
 
        return count;
    }
 
    @Override
    public void close() {
        isOpen = false;
    }
 
    @Override
    public boolean isOpened() {
        return isOpen;
    }
}