Files

126 lines
2.9 KiB
Go

package hardware
import (
"errors"
"fmt"
"strconv"
"strings"
"periph.io/x/conn/v3/gpio/gpioreg"
"github.com/sirupsen/logrus"
"github.com/BeatGlow/beatglow/config"
"github.com/BeatGlow/display"
)
func Display(config *config.DisplayConfig) (display.Display, error) {
log := logrus.WithFields(logrus.Fields{
"driver": config.Type,
"mode": config.Mode,
"addr": config.Address,
"bus": config.Bus,
"reset": config.Reset,
"dc": config.DC,
"cs": config.CS,
"bl": config.BL,
})
log.Debug("setup display")
//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)
}
log.WithFields(logrus.Fields{
"reset": options.Reset,
"backlight": options.Backlight,
"width": options.Width,
"height": options.Height,
}).Info("loading display driver")
switch strings.ToUpper(config.Type) {
case "GP1278":
return display.GP1278(conn, options)
case "GP1294":
return display.GP1294(conn, options)
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
}