104 lines
2.3 KiB
Go
104 lines
2.3 KiB
Go
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
|
|
}
|