- for incoming_request := range cmd_chans.In() {
- reply, err := HandleCommand(incoming_request, pub_chans.Out(), serial_wr, serial_rd)
- if err != nil {
- cmd_chans.Out() <- [][]byte{[]byte("ERROR"), []byte(err.Error())}
- log.Print(err)
- } else {
- cmd_chans.Out() <- reply
- }
+ var next_incoming_serial_is_client_reply bool
+ timeout_chan := make(chan bool)
+ defer close(timeout_chan)
+ for {
+ select {
+ case incoming_ser_line, is_notclosed := <- serial_rd:
+ if is_notclosed {
+ //~ if Syslog_ != nil { Syslog_.Print(ByteArrayToString(incoming_ser_line)) }
+ if Syslog_ != nil { Syslog_.Printf("%s",incoming_ser_line) }
+ if next_incoming_serial_is_client_reply {
+ next_incoming_serial_is_client_reply = false
+ cmd_chans.Out() <- incoming_ser_line
+ }
+ pub_chans.Out() <- incoming_ser_line
+ } else {
+ Syslog_.Print("serial device disappeared, exiting")
+ os.Exit(1)
+ }
+ case tv, timeout_notclosed := <- timeout_chan:
+ if timeout_notclosed && tv && next_incoming_serial_is_client_reply {
+ next_incoming_serial_is_client_reply = false
+ cmd_chans.Out() <- [][]byte{[]byte("ERROR"), []byte("No reply from firmware")}
+ }
+ case incoming_request, ic_notclosed := <- cmd_chans.In():
+ if ! ic_notclosed {
+ Syslog_.Print("zmq socket died, exiting")
+ os.Exit(2)
+ }
+ if string(incoming_request[0]) == "log" {
+ if len(incoming_request) < 2 {
+ cmd_chans.Out() <- [][]byte{[]byte("ERROR"), []byte("argument missing")}
+ continue
+ }
+ Syslog_.Printf("Log: %s",incoming_request[1:])
+ cmd_chans.Out() <- [][]byte{[]byte("Ok")}
+ continue
+ }
+ Syslog_.Printf("%s",incoming_request)
+ if err := HandleCommand(incoming_request, serial_wr, serial_rd); err != nil {
+ out_msg := [][]byte{[]byte("ERROR"), []byte(err.Error())}
+ cmd_chans.Out() <- out_msg
+ } else {
+ pub_chans.Out() <- incoming_request
+ next_incoming_serial_is_client_reply = true
+ go func(){time.Sleep(3*time.Second); timeout_chan <- true;}()
+ }
+ }