Created a devices service and moved the CDashDisplay service to the sahdow realm

devices/cdashdisplay/connect.go

@@ -0,0 +1,96 @@
+package cdashdisplay
+
+import (
+	"esdi/peripheral/communication"
+	"esdi/peripheral/communication/packets"
+	"fmt"
+	"time"
+
+	"github.com/tarm/serial"
+	portp "go.bug.st/serial"
+)
+
+func listPorts() ([]string, error) {
+	ports, err := portp.GetPortsList()
+	if err != nil {
+		return []string{}, err
+	}
+
+	return ports, nil
+}
+
+func probe(WT *communication.WalkieTalkie) error {
+	err := WT.TurnOn()
+	if err != nil {
+		return err
+	}
+
+	// Send the identification command
+	cmd := communication.CmdRequestID
+	var response packets.IdentificationPacket
+	err = WT.SendCommand(cmd, []byte{0x06, 0x07, 0x08, 0x09}, &response)
+	if err != nil {
+		return err
+	}
+
+	if response.DeviceID != 0x01 {
+		return fmt.Errorf("wrong ID")
+	}
+
+	return nil
+}
+
+func findDisplayPort() (*communication.WalkieTalkie, error) {
+	ports, err := listPorts()
+	if err != nil {
+		return nil, err
+	}
+
+	pLogger.Info(fmt.Sprintf("Looking into %v", ports))
+
+	var wt *communication.WalkieTalkie
+	for _, port := range ports {
+		pLogger.Info(fmt.Sprintf("Trying port %s", port))
+
+		wt = &communication.WalkieTalkie{
+			Cfg: &serial.Config{
+				Name:        port,
+				Baud:        115200,
+				ReadTimeout: 500 * time.Millisecond,
+			},
+		}
+
+		pLogger.Info(fmt.Sprintf("Started probing port %s", port))
+
+		probeResult := make(chan error, 1)
+
+		go func() {
+			probeResult <- probe(wt)
+		}()
+
+		select {
+		case err = <-probeResult:
+			// Probe completed normally (could be success or error)
+		case <-time.After(2 * time.Second):
+			// Hard timeout reached
+			err = fmt.Errorf("probe completely hung/timed out: %s", port)
+		}
+
+		pLogger.Info(fmt.Sprintf("Finished probing port %s", port))
+
+		if err == nil {
+			pLogger.Info(fmt.Sprintf("Success probing port %s: %+v", port, err))
+			break
+		}
+
+		pLogger.Info(fmt.Sprintf("wasn't port %s", port))
+		wt = nil
+	}
+
+	if wt == nil {
+		return nil, fmt.Errorf("couldn't find cdashdisplay")
+	}
+
+	pLogger.Info(fmt.Sprintf("found cdashdisplay on port: %s", wt.Cfg.Name))
+	return wt, nil
+}