package hardware import ( "errors" "fmt" "log" "strconv" "strings" "periph.io/x/conn/v3/gpio/gpioreg" "github.com/BeatGlow/beatglow/config" "github.com/BeatGlow/display" ) func Display(config *config.DisplayConfig) (display.Display, error) { log.Printf("display: %#+v", config) var ( conn display.Conn err error ) switch strings.ToUpper(config.Mode) { case "", "I2C", "I²C": var ( addr uint64 bus = -1 ) if addr, err = strconv.ParseUint(config.Address, 16, 16); err != nil { return nil, fmt.Errorf("invalid display addr %q: %w", config.Address, err) } if config.Bus != "" { if bus, err = strconv.Atoi(config.Bus); err != nil { return nil, fmt.Errorf("invalid bus %q: %w", config.Bus, err) } } conn, err = display.OpenI2C(&display.I2CConfig{ Addr: uint8(addr), Device: bus, Reset: gpioreg.ByName(config.Reset), }) case "SPI": conn, err = display.OpenSPI(&display.SPIConfig{ Reset: gpioreg.ByName(config.Reset), DC: gpioreg.ByName(config.DC), }) default: return nil, fmt.Errorf("display: unknown mode %q", config.Mode) } if err != nil { return nil, err } var options = &display.Config{ Reset: gpioreg.ByName(config.Reset), Backlight: gpioreg.ByName(config.BL), } if options.Width, options.Height, err = parseSize(config.Size); err != nil { _ = conn.Close() return nil, fmt.Errorf("display: invalid size %q: %w", config.Size, err) } switch strings.ToUpper(config.Type) { case "SH1106": return display.SH1106(conn, options) case "SSD1322": return display.SSD1322(conn, options) case "ST7735": return display.ST7735(conn, options) case "ST7789": return display.ST7789(conn, options) default: _ = conn.Close() return nil, fmt.Errorf("display: unknown type %q", config.Type) } } func parseSize(size string) (width, height int, err error) { if size == "" { return } i := strings.IndexByte(size, 'x') if i == -1 { return 0, 0, errors.New("invalid size format; expected WxH, Wx or xH") } else if i == 0 { height, err = strconv.Atoi(size[1:]) return } else if i == len(size)-1 { width, err = strconv.Atoi(size[:len(size)-1]) return } if width, err = strconv.Atoi(size[:i]); err != nil { return } if height, err = strconv.Atoi(size[i+1:]); err != nil { return } return }