X-Git-Url: https://git.realraum.at/?a=blobdiff_plain;f=go%2Fdoor_daemon_zmq%2Fserial_tty.go;h=ac6b1bb0b33ace26c33d354a968ea3dba14315a3;hb=a87c91b7d4544703879b7ef6e472b863765e3949;hp=89f0b0c9e41117b8786d8693204933b6959c0719;hpb=f2a09928c3c1d406452098cb15f663a62611fc95;p=svn42.git diff --git a/go/door_daemon_zmq/serial_tty.go b/go/door_daemon_zmq/serial_tty.go index 89f0b0c..ac6b1bb 100644 --- a/go/door_daemon_zmq/serial_tty.go +++ b/go/door_daemon_zmq/serial_tty.go @@ -3,25 +3,36 @@ package main import ( - "fmt" "bufio" "bytes" "os" + "errors" "svn.spreadspace.org/realraum/go.svn/termios" - "log" ) + // ---------- Serial TTY Code ------------- -func openTTY(name string) (*os.File, error) { - file, err := os.OpenFile(name,os.O_RDWR, 0600) // For read access. - if err != nil { - log.Println(err.Error()) - return nil, err +func openTTY(name string, speed uint) (file *os.File, err error) { + file, err = os.OpenFile(name,os.O_RDWR, 0666) + if err != nil { return } + if err = termios.SetRawFile(file); err != nil { return } + switch speed { + case 0: // set no baudrate + case 1200: err = termios.SetSpeedFile(file, termios.B1200) + case 2400: err = termios.SetSpeedFile(file, termios.B2400) + case 4800: err = termios.SetSpeedFile(file, termios.B4800) + case 9600: err = termios.SetSpeedFile(file, termios.B9600) + case 19200: err = termios.SetSpeedFile(file, termios.B19200) + case 38400: err = termios.SetSpeedFile(file, termios.B38400) + case 57600: err = termios.SetSpeedFile(file, termios.B57600) + case 115200: err = termios.SetSpeedFile(file, termios.B115200) + case 230400: err = termios.SetSpeedFile(file, termios.B230400) + default: + file.Close() + err = errors.New("Unsupported Baudrate, use 0 to disable setting a baudrate") } - termios.Ttyfd(file.Fd()) - termios.SetRaw() - return file, nil + return } func serialWriter(in <- chan string, serial * os.File) { @@ -29,6 +40,7 @@ func serialWriter(in <- chan string, serial * os.File) { serial.WriteString(totty) serial.Sync() } + serial.Close() } func serialReader(out chan <- [][]byte, serial * os.File) { @@ -36,7 +48,7 @@ func serialReader(out chan <- [][]byte, serial * os.File) { linescanner.Split(bufio.ScanLines) for linescanner.Scan() { if err := linescanner.Err(); err != nil { - panic(fmt.Sprintf("Error in read from serial: %v\n",err.Error())) + panic(err.Error()) } text := bytes.Fields([]byte(linescanner.Text())) if len(text) == 0 { @@ -46,12 +58,12 @@ func serialReader(out chan <- [][]byte, serial * os.File) { } } -func OpenAndHandleSerial(filename string) (chan string, chan [][]byte, error) { - serial, err :=openTTY(filename) +func OpenAndHandleSerial(filename string, serspeed uint) (chan string, chan [][]byte, error) { + serial, err :=openTTY(filename, serspeed) if err != nil { return nil, nil, err } - wr := make(chan string) + wr := make(chan string, 1) rd := make(chan [][]byte, 20) go serialWriter(wr, serial) go serialReader(rd, serial)