public static byte[] bitStuff(byte[] data) {
    final byte FLAG = 0x7E;
    final byte ESCAPE = 0x7D;

    // Create a new byte array to store the stuffed data
    byte[] stuffedData = new byte[data.length * 2];

    // Keep track of the current index in the stuffed data array
    int stuffedIndex = 0;

    // Iterate through the original data
    for (int i = 0; i < data.length; i++) {
        byte b = data[i];

        // If the current byte is the flag or escape byte, stuff it
        if (b == FLAG || b == ESCAPE) {
            stuffedData[stuffedIndex++] = ESCAPE;
            stuffedData[stuffedIndex++] = (byte) (b ^ 0x20);
        } else {
            stuffedData[stuffedIndex++] = b;
        }
    }

    return stuffedData;
}

public static byte[] bitUnStuff(byte[] data) {
    final byte FLAG = 0x7E;
    final byte ESCAPE = 0x7D;

    // Create a new byte array to store the unstuffed data
    byte[] unstuffedData = new byte[data.length];

    // Keep track of the current index in the unstuffed data array
    int unstuffedIndex = 0;

    // Iterate through the stuffed data
    for (int i = 0; i < data.length; i++) {
        byte b = data[i];

        // If the current byte is the escape byte, unstuff the next byte
        if (b == ESCAPE) {
            unstuffedData[unstuffedIndex++] = (byte) (data[++i] ^ 0x20);
        } else {
            unstuffedData[unstuffedIndex++] = b;
        }
    }

    return unstuffedData;
}

public static void main(String[] args) {
   byte[] data = {0x48, 0x65, 0x6C, 0x6C, 0x6F, 0x7E};  // Hello~
   byte[] stuffedData = bitStuff(data);
   System.out.println("Original Data: "+Arrays.toString(data));
   System.out.println("Stuffed Data: "+ Arrays.toString(stuffedData));

   byte[] unstuffedData = bitUnStuff(stuffedData);
   System.out.println("Unstuffed Data: "+ Arrays.toString(unstuffedData));
}

0x48, 0x65, 0x6C, 0x6C, 0x6F, 0x7E,

Original Data: [72, 101, 108, 108, 111, 126]
Stuffed Data: [72, 101, 108, 108, 111, 93, 30, 126]
Unstuffed Data: [72, 101, 108, 108, 111, 126]