org.cc86.MMC.modules.audio.SWTTYProvider.java Source code

Introduction

Here is the source code for org.cc86.MMC.modules.audio.SWTTYProvider.java

Source

/*
 * To change this license header, choose License Headers in Project Properties.
 * To change this template file, choose Tools | Templates
 * and open the template in the editor.
 */
package org.cc86.MMC.modules.audio;

import de.nplusc.izc.tools.baseTools.Tools;
import java.io.ByteArrayOutputStream;
import java.io.File;
import java.io.FileInputStream;
import java.io.FileOutputStream;
import java.io.IOException;
import java.io.InputStream;
import java.io.OutputStream;
import java.io.PrintStream;
import java.util.ArrayList;
import java.util.Arrays;
import java.util.List;
import java.util.concurrent.BlockingQueue;
import java.util.function.Consumer;
import org.apache.commons.io.output.NullOutputStream;
import org.apache.logging.log4j.LogManager;
import org.apache.logging.log4j.Logger;
import org.apache.logging.log4j.io.IoBuilder;

/**
 *
 * @author tgoerner
 */
public class SWTTYProvider implements TTYProvider {
    //startup sudo pigpiod
    //M 10 W nach /dev/pigpio
    //Output in /dev/pigout
    //M 9 R
    private static final Logger l = LogManager.getLogger();
    //cat auf /dev/pigout & /dev/pigerr
    //static String[] alphabet = "a#b#c#d#e#f#g#h#i#j#k#l#m#n#o#p#q#r#s#t#u#v#w#x#y#z".split("#");

    private int bytesReceived;
    private int bytesErrored;

    /**
     * @param args the command line arguments
     */
    public static void main(String[] args) {
        //new SWTTYProvider().uartHandler(System.out::println, System.in, true);
    }

    private static void setup() {
        Tools.runCmdWithPassthru(IoBuilder.forLogger("External.sudoedChmod").buildPrintStream(), "sudo", "chmod",
                "777", "/sys/class/softuart/softuart/data");
        Tools.runCmdWithPassthru(new PrintStream(new NullOutputStream()), "cat",
                "/sys/class/softuart/softuart/data");
    }

    @Override
    public void uartHandler(final Consumer<Byte[]> out, final BlockingQueue<byte[]> ctrl, final boolean addPrefix) {
        new Thread(() -> {
            InputStream fis = null;
            OutputStream fos = null;

            try {
                //final Socket s = new Socket("127.0.0.1", 8888);
                //fis = new FileInputStream();
                if (!new File("/sys/class/softuart/softuart/data").exists()) {
                    System.out.println("no running softuart driver, shutting down");
                    System.exit(0);
                }

                setup();
                //("/home/pi/codestuff/uartdmp");//
                fos = new FileOutputStream("/sys/class/softuart/softuart/data");
                PrintStream ps = new PrintStream(fos);
                //fos = s.getOutputStream();/*new InputStreamReader(s.getInputStream()*/

                new Thread(() -> {
                    FileInputStream br;
                    try {
                        byte[] data = new byte[3192];
                        //br = 
                        //br.mark(4096);
                        ByteArrayOutputStream bs = new ByteArrayOutputStream();
                        while (true) {
                            List<Byte> bfr = new ArrayList<Byte>();
                            FileInputStream fi = new FileInputStream("/sys/class/softuart/softuart/data");
                            //Tools.runCmdWithPassthru(new PrintStream(bs), "cat","/sys/class/softuart/softuart/data");

                            int len = fi.read(data);
                            //bs.reset();
                            //int len=data.length;
                            if (len < 0) {
                                try {
                                    Thread.sleep(10);
                                } catch (InterruptedException ex) {
                                }
                                continue;
                            }
                            l.trace("data rcvd, len={}" + len);
                            for (int i = 0; i < len; i += 2) {
                                int datapkg = ((data[i] & 0xF0) >>> 4) | ((data[i + 1] & 0xF0));
                                datapkg |= ((data[i + 1] & 0x08) << 5);
                                boolean parity = numberOfSetBits(datapkg) % 2 == 0;
                                l.trace(String.format("%03X", datapkg));
                                bytesReceived++;
                                if (parity) {
                                    l.trace(datapkg);
                                    bfr.add((byte) (datapkg & 0xff));

                                } else {
                                    bytesErrored++;
                                }
                            }
                            out.accept(bfr.toArray(new Byte[0]));

                            try {
                                Thread.sleep(10);
                            } catch (InterruptedException ex) {
                            }
                        }
                    } /*catch (FileNotFoundException ex)
                      {
                      ex.printStackTrace();
                      } */catch (IOException ex) //noop-catch killme
                    {
                        ex.printStackTrace();
                    }
                }).start();//*/
                //BufferedReader bs = new BufferedReader(new InputStreamReader(ctrl));
                while (true) {
                    //l.warn("d'arvit");
                    byte[] thebyte = ctrl.take();//alphabet[new Random().nextInt(26)] + alphabet[new Random().nextInt(26)] + alphabet[new Random().nextInt(26)] + "\r\n";
                    l.trace("SENT_UART:" + Arrays.toString(thebyte));
                    StringBuilder sb = new StringBuilder();
                    for (Byte pkgbyte : thebyte) {
                        sb.append("\\x").append(String.format("%02X", pkgbyte));
                    }
                    String echo = sb + "";
                    l.trace(echo);
                    Tools.runCmdWithPassthru(System.out, "/bin/bash", "-c",
                            "echo -ne '" + echo + "'>/sys/class/softuart/softuart/data");
                    //ps.write(new byte[]{thebyte});
                    //ps.flush();
                    //fos.flush();
                    //Thread.sleep(1000);
                }
            } catch (Exception ex) {
                ex.printStackTrace();
            } finally {
                try {
                    //fis.close();
                    fos.close();
                } catch (IOException ex) {
                    ex.printStackTrace();
                }
            }
        }).start();
    }

    private static int numberOfSetBits(int i) {
        // Java: use >>> instead of >>
        // C or C++: use uint32_t
        i = i - ((i >>> 1) & 0x55555555);
        i = (i & 0x33333333) + ((i >>> 2) & 0x33333333);
        return (((i + (i >>> 4)) & 0x0F0F0F0F) * 0x01010101) >>> 24;
    }
}