|
|
|
@ -5,27 +5,19 @@ import (
|
|
|
|
|
"fmt"
|
|
|
|
|
"image"
|
|
|
|
|
"log"
|
|
|
|
|
"math/rand"
|
|
|
|
|
"time"
|
|
|
|
|
|
|
|
|
|
"gitea.unprism.ru/yotia/display-test/pkg/mt12232a"
|
|
|
|
|
"github.com/stianeikeland/go-rpio/v4"
|
|
|
|
|
)
|
|
|
|
|
|
|
|
|
|
var _ = rand.Int() // TMP for import to exist
|
|
|
|
|
|
|
|
|
|
type displayMt12232a struct {
|
|
|
|
|
logger *log.Logger
|
|
|
|
|
|
|
|
|
|
// GPIO pins
|
|
|
|
|
dev mt12232a.Device
|
|
|
|
|
|
|
|
|
|
submitCtx context.Context // Context for submit goroutine
|
|
|
|
|
submitCtxCancel context.CancelFunc
|
|
|
|
|
submitQueue chan uint16 // Rectangle for submit
|
|
|
|
|
// From highter to lower:
|
|
|
|
|
// 1 bit - cristal
|
|
|
|
|
// 2 pit - page
|
|
|
|
|
// 6 bit - x in coords of crystal
|
|
|
|
|
// 6 bit - len
|
|
|
|
|
// Sum - 15 bit
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
func newMt12232a(logger *log.Logger) (Display, error) {
|
|
|
|
@ -44,28 +36,28 @@ func newMt12232a(logger *log.Logger) (Display, error) {
|
|
|
|
|
// }
|
|
|
|
|
|
|
|
|
|
// Setup submit goroutine
|
|
|
|
|
ctx, cancel := context.WithCancel(context.Background())
|
|
|
|
|
d := displayMt12232a{
|
|
|
|
|
logger: logger,
|
|
|
|
|
dev: dev,
|
|
|
|
|
submitCtx: ctx,
|
|
|
|
|
submitCtxCancel: cancel,
|
|
|
|
|
logger: logger,
|
|
|
|
|
dev: dev,
|
|
|
|
|
}
|
|
|
|
|
defer d.submitLoop()
|
|
|
|
|
|
|
|
|
|
// Temp debug draw
|
|
|
|
|
d.status("start")
|
|
|
|
|
//if st0, st1 := d.dev.ReadStatus(0), d.dev.ReadStatus(1); false { //st0&0x20 == 0 && st1&0x20 == 0 {
|
|
|
|
|
// d.logger.Println("Display is already on")
|
|
|
|
|
//} else {
|
|
|
|
|
d.status("Setup start")
|
|
|
|
|
if err := d.dev.Reset(); err != nil {
|
|
|
|
|
return nil, fmt.Errorf("reset: %w", err)
|
|
|
|
|
}
|
|
|
|
|
d.status("After reset")
|
|
|
|
|
time.Sleep(200 * time.Millisecond)
|
|
|
|
|
if st0, st1 := d.dev.ReadStatus(0), d.dev.ReadStatus(1); st0 == 0 && st1 == 0 {
|
|
|
|
|
return nil, fmt.Errorf("No status response from dysplay")
|
|
|
|
|
}
|
|
|
|
|
if err := d.powerOn(); err != nil {
|
|
|
|
|
return nil, fmt.Errorf("power on: %w", err)
|
|
|
|
|
}
|
|
|
|
|
d.status("end")
|
|
|
|
|
d.status("test start")
|
|
|
|
|
d.test()
|
|
|
|
|
d.status("test end")
|
|
|
|
|
|
|
|
|
|
d.status("Setup end")
|
|
|
|
|
return &d, nil
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
@ -74,63 +66,55 @@ func (d *displayMt12232a) status(label string) {
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
func (d *displayMt12232a) powerOn() error {
|
|
|
|
|
d.logger.Println("Power on")
|
|
|
|
|
if err := d.dev.WriteCode(0, 0xE2); err != nil { // Reset
|
|
|
|
|
// Reset
|
|
|
|
|
if err := d.dev.WriteCode(0, 0xE2); err != nil {
|
|
|
|
|
return fmt.Errorf("reset: %w", err)
|
|
|
|
|
}
|
|
|
|
|
d.status("1L")
|
|
|
|
|
if err := d.dev.WriteCode(1, 0xE2); err != nil { // Reset
|
|
|
|
|
if err := d.dev.WriteCode(1, 0xE2); err != nil {
|
|
|
|
|
return fmt.Errorf("reset: %w", err)
|
|
|
|
|
}
|
|
|
|
|
d.status("1R")
|
|
|
|
|
if err := d.dev.WriteCode(0, 0xEE); err != nil { // ReadModifyWrite off
|
|
|
|
|
// ReadModifyWrite off
|
|
|
|
|
if err := d.dev.WriteCode(0, 0xEE); err != nil {
|
|
|
|
|
return fmt.Errorf("RMW off: %w", err)
|
|
|
|
|
}
|
|
|
|
|
d.status("2L")
|
|
|
|
|
if err := d.dev.WriteCode(1, 0xEE); err != nil { // ReadModifyWrite off
|
|
|
|
|
if err := d.dev.WriteCode(1, 0xEE); err != nil {
|
|
|
|
|
return fmt.Errorf("RMW off: %w", err)
|
|
|
|
|
}
|
|
|
|
|
d.status("2R")
|
|
|
|
|
if err := d.dev.WriteCode(0, 0xA4); err != nil { // Turn on common mode
|
|
|
|
|
// Turn on common mode
|
|
|
|
|
if err := d.dev.WriteCode(0, 0xA4); err != nil {
|
|
|
|
|
return fmt.Errorf("turn on common mode: %w", err)
|
|
|
|
|
}
|
|
|
|
|
d.status("3L")
|
|
|
|
|
if err := d.dev.WriteCode(1, 0xA4); err != nil { // Turn on common mode
|
|
|
|
|
if err := d.dev.WriteCode(1, 0xA4); err != nil {
|
|
|
|
|
return fmt.Errorf("turn on common mode: %w", err)
|
|
|
|
|
}
|
|
|
|
|
d.status("3R")
|
|
|
|
|
if err := d.dev.WriteCode(0, 0xA9); err != nil { // Multiplex 1/32
|
|
|
|
|
// Multiplex 1/32
|
|
|
|
|
if err := d.dev.WriteCode(0, 0xA9); err != nil {
|
|
|
|
|
return fmt.Errorf("multiplex 1/32: %w", err)
|
|
|
|
|
}
|
|
|
|
|
d.status("4L")
|
|
|
|
|
if err := d.dev.WriteCode(1, 0xA9); err != nil { // Multiplex 1/32
|
|
|
|
|
if err := d.dev.WriteCode(1, 0xA9); err != nil {
|
|
|
|
|
return fmt.Errorf("multiplex 1/32: %w", err)
|
|
|
|
|
}
|
|
|
|
|
d.status("4R")
|
|
|
|
|
if err := d.dev.WriteCode(0, 0xC0); err != nil { // Top line to 0
|
|
|
|
|
// Top line to 0
|
|
|
|
|
if err := d.dev.WriteCode(0, 0xC0); err != nil {
|
|
|
|
|
return fmt.Errorf("top line to 0: %w", err)
|
|
|
|
|
}
|
|
|
|
|
d.status("5L")
|
|
|
|
|
if err := d.dev.WriteCode(1, 0xC0); err != nil { // Top line to 0
|
|
|
|
|
if err := d.dev.WriteCode(1, 0xC0); err != nil {
|
|
|
|
|
return fmt.Errorf("top line to 0: %w", err)
|
|
|
|
|
}
|
|
|
|
|
d.status("5R")
|
|
|
|
|
if err := d.dev.WriteCode(0, 0xA0); err != nil { // Invert scan RAM
|
|
|
|
|
// Invert scan RAM
|
|
|
|
|
if err := d.dev.WriteCode(0, 0xA1); err != nil {
|
|
|
|
|
return fmt.Errorf("inver scan RAM: %w", err)
|
|
|
|
|
}
|
|
|
|
|
d.status("6L")
|
|
|
|
|
if err := d.dev.WriteCode(1, 0xA0); err != nil { // Invert scan RAM
|
|
|
|
|
if err := d.dev.WriteCode(1, 0xA0); err != nil {
|
|
|
|
|
return fmt.Errorf("inver scan RAM: %w", err)
|
|
|
|
|
}
|
|
|
|
|
d.status("6R")
|
|
|
|
|
if err := d.dev.WriteCode(0, 0xAF); err != nil { // Display on
|
|
|
|
|
// Display on
|
|
|
|
|
if err := d.dev.WriteCode(0, 0xAF); err != nil {
|
|
|
|
|
return fmt.Errorf("display on: %w", err)
|
|
|
|
|
}
|
|
|
|
|
d.status("7L")
|
|
|
|
|
if err := d.dev.WriteCode(1, 0xAF); err != nil { // Display on
|
|
|
|
|
if err := d.dev.WriteCode(1, 0xAF); err != nil {
|
|
|
|
|
return fmt.Errorf("display on: %w", err)
|
|
|
|
|
}
|
|
|
|
|
d.status("7R")
|
|
|
|
|
|
|
|
|
|
//time.Sleep(time.Second)
|
|
|
|
|
|
|
|
|
@ -140,25 +124,91 @@ func (d *displayMt12232a) powerOn() error {
|
|
|
|
|
if d.dev.ReadStatus(0)&0x20 != 0 {
|
|
|
|
|
return fmt.Errorf("Left cristal is off")
|
|
|
|
|
}
|
|
|
|
|
if d.dev.ReadStatus(1)&0x20 != 0 {
|
|
|
|
|
return fmt.Errorf("Right cristal is off")
|
|
|
|
|
}
|
|
|
|
|
return nil
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
func (d *displayMt12232a) test() {
|
|
|
|
|
d.logger.Println("Write")
|
|
|
|
|
func (d *displayMt12232a) Test(ctx context.Context) error {
|
|
|
|
|
//d.logger.Println("Write")
|
|
|
|
|
|
|
|
|
|
d.dev.WriteCode(0, 0xB8)
|
|
|
|
|
d.dev.WriteCode(0, 0x00)
|
|
|
|
|
d.dev.WriteData(0, 47)
|
|
|
|
|
d.logger.Println("Read")
|
|
|
|
|
d.dev.WriteCode(0, 0xB8)
|
|
|
|
|
d.dev.WriteCode(0, 0x00)
|
|
|
|
|
d.logger.Println(d.dev.ReadData(0))
|
|
|
|
|
d.logger.Println(d.dev.ReadData(0))
|
|
|
|
|
d.dev.WriteCode(0, 0x13)
|
|
|
|
|
for range 61 {
|
|
|
|
|
d.dev.WriteData(0, 0xFF)
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
for c := range 256 {
|
|
|
|
|
select {
|
|
|
|
|
case <-ctx.Done():
|
|
|
|
|
return nil
|
|
|
|
|
default:
|
|
|
|
|
if c == 0xA0 {
|
|
|
|
|
continue
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
// Write
|
|
|
|
|
d.dev.WriteCode(0, 0xB8)
|
|
|
|
|
d.dev.WriteCode(0, 0x13)
|
|
|
|
|
d.dev.WriteData(0, byte(c)) // 0x13
|
|
|
|
|
d.dev.WriteData(0, byte(c)) // 0x14
|
|
|
|
|
//d.logger.Printf("--- %x ---\n", c)
|
|
|
|
|
|
|
|
|
|
// Check status
|
|
|
|
|
if d.dev.ReadStatus(0) != 0 {
|
|
|
|
|
d.logger.Printf("error status on %x status: %08b\n", c, d.dev.ReadStatus(0))
|
|
|
|
|
if err := d.dev.Reset(); err != nil {
|
|
|
|
|
return fmt.Errorf("reset: %w", err)
|
|
|
|
|
}
|
|
|
|
|
if err := d.powerOn(); err != nil {
|
|
|
|
|
return fmt.Errorf("power on: %w", err)
|
|
|
|
|
}
|
|
|
|
|
continue
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
// Read
|
|
|
|
|
d.dev.WriteCode(0, 0x13)
|
|
|
|
|
if _, err := d.dev.ReadData(0); err != nil { // Empty
|
|
|
|
|
return fmt.Errorf("read data 0: %w", err)
|
|
|
|
|
}
|
|
|
|
|
rc0, err := d.dev.ReadData(0) // 0x13
|
|
|
|
|
if err != nil {
|
|
|
|
|
return fmt.Errorf("read data 1: %w", err)
|
|
|
|
|
}
|
|
|
|
|
rc1, err := d.dev.ReadData(0) // 0x13
|
|
|
|
|
if err != nil {
|
|
|
|
|
return fmt.Errorf("read data 1: %w", err)
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if rc0 != byte(c) {
|
|
|
|
|
d.logger.Println("Not write 0x13", c)
|
|
|
|
|
}
|
|
|
|
|
if rc1 != byte(c) {
|
|
|
|
|
d.logger.Println("Not write 0x14", c)
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
time.Sleep(20 * time.Millisecond)
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
//d.dev.WriteData(0, 0xAE)
|
|
|
|
|
return nil
|
|
|
|
|
//d.logger.Println("Read")
|
|
|
|
|
//d.dev.WriteCode(0, 0x14)
|
|
|
|
|
//d.logger.Println(d.dev.ReadData(0))
|
|
|
|
|
//d.logger.Println(d.dev.ReadData(0))
|
|
|
|
|
//d.logger.Println(d.dev.ReadData(0))
|
|
|
|
|
//d.logger.Println(d.dev.ReadData(0))
|
|
|
|
|
//d.logger.Println(d.dev.ReadData(0))
|
|
|
|
|
//d.logger.Println(d.dev.ReadData(0))
|
|
|
|
|
//d.logger.Println(d.dev.ReadData(0))
|
|
|
|
|
|
|
|
|
|
//color := []byte{1, 0, 1, 0, 1, 0, 1, 0}
|
|
|
|
|
//color := []byte{1, 0, 1, 0, 1, 0, 0, 0}
|
|
|
|
|
|
|
|
|
|
//color := []byte{0, 0, 0, 0, 0, 0, 0, 0}
|
|
|
|
|
//color := byte(3)
|
|
|
|
|
//return
|
|
|
|
|
start := time.Now()
|
|
|
|
|
//d.dev.WriteCodeL(0xB8)
|
|
|
|
|
//d.dev.WriteCodeL(0x13)
|
|
|
|
@ -183,26 +233,30 @@ func (d *displayMt12232a) test() {
|
|
|
|
|
//d.dev.WriteDatasL([]byte{1, 0, 1, 0, 1, 0, 0, 0})
|
|
|
|
|
//d.dev.WriteDatasL([]byte{1, 0, 1, 0, 1, 0, 1, 0})
|
|
|
|
|
|
|
|
|
|
//d.status("4")
|
|
|
|
|
d.status("4")
|
|
|
|
|
for p := byte(0); p < 4; p++ {
|
|
|
|
|
d.dev.WriteCode(0, p|0xB8)
|
|
|
|
|
// d.status("5")
|
|
|
|
|
d.dev.WriteCode(0, 0x13)
|
|
|
|
|
//d.status("6")
|
|
|
|
|
for c := 0; c < 61; c++ {
|
|
|
|
|
//d.dev.WriteDatas(0, []byte{byte(rand.Int() % 2), byte(rand.Int() % 2), byte(rand.Int() % 2), byte(rand.Int() % 2), byte(rand.Int() % 2), byte(rand.Int() % 2), byte(rand.Int() % 2), byte(rand.Int() % 2)})
|
|
|
|
|
d.dev.WriteDatas(0, []byte{0, 0, 0, 0, 0, 0, 0, 0})
|
|
|
|
|
//d.dev.WriteData(0, byte(0xF0^(0xFF*(c%2))))
|
|
|
|
|
d.dev.WriteData(0, byte(rand.Int())>>1)
|
|
|
|
|
//d.dev.WriteData(0, 0xF2)
|
|
|
|
|
//d.dev.WriteData(0, 0xF0)
|
|
|
|
|
//time.Sleep(2 * time.Millisecond)
|
|
|
|
|
}
|
|
|
|
|
d.dev.WriteCode(1, p|0xB8)
|
|
|
|
|
d.dev.WriteCode(1, 0x00)
|
|
|
|
|
for c := 0; c < 61; c++ {
|
|
|
|
|
//d.dev.WriteDatas(1, []byte{byte(rand.Int() % 2), byte(rand.Int() % 2), byte(rand.Int() % 2), byte(rand.Int() % 2), byte(rand.Int() % 2), byte(rand.Int() % 2), byte(rand.Int() % 2), byte(rand.Int() % 2)})
|
|
|
|
|
//d.dev.WriteData(1, byte(rand.Int()))
|
|
|
|
|
//d.dev.WriteData(1, byte(4*int(p)+c))
|
|
|
|
|
//d.dev.WriteData(1, 0xF0+byte(rand.Int()%2))
|
|
|
|
|
d.dev.WriteData(1, byte(rand.Int())>>1)
|
|
|
|
|
//time.Sleep(2 * time.Millisecond)
|
|
|
|
|
}
|
|
|
|
|
////d.status("7")
|
|
|
|
|
//d.dev.WriteCode(1, p|0xB8)
|
|
|
|
|
////d.status("8")
|
|
|
|
|
//d.dev.WriteCode(1, 0x00)
|
|
|
|
|
//for c := 0; c < 61; c++ {
|
|
|
|
|
// d.dev.WriteDatas(1, []byte{byte(rand.Int() % 2), byte(rand.Int() % 2), byte(rand.Int() % 2), byte(rand.Int() % 2), byte(rand.Int() % 2), byte(rand.Int() % 2), byte(rand.Int() % 2), byte(rand.Int() % 2)})
|
|
|
|
|
// //d.dev.WriteDatas(1, []byte{0, 0, 0, 1, 0, 0, 0, 0})
|
|
|
|
|
//}
|
|
|
|
|
}
|
|
|
|
|
//d.status("9")
|
|
|
|
|
d.status("9")
|
|
|
|
|
end := time.Now()
|
|
|
|
|
d.logger.Println(end.Sub(start))
|
|
|
|
|
// for p := byte(0); p < 8; p++ {
|
|
|
|
@ -219,6 +273,7 @@ func (d *displayMt12232a) test() {
|
|
|
|
|
// }
|
|
|
|
|
//d.dev.WriteCodeL(0xAF) // Display on
|
|
|
|
|
//d.dev.WriteCodeR(0xAF) // Display on
|
|
|
|
|
return nil
|
|
|
|
|
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
@ -261,23 +316,6 @@ func (d *displayMt12232a) Flush(img *image.Gray) error {
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
func (d *displayMt12232a) Close() error {
|
|
|
|
|
if d.submitCtxCancel != nil {
|
|
|
|
|
d.submitCtxCancel()
|
|
|
|
|
}
|
|
|
|
|
return rpio.Close()
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
func (d *displayMt12232a) submitLoop() {
|
|
|
|
|
// for {
|
|
|
|
|
// select {
|
|
|
|
|
// case <-d.submitCtx.Done():
|
|
|
|
|
// return
|
|
|
|
|
// case msg := <-d.submitQueue:
|
|
|
|
|
// crystal := (msg >> 14) & 0x01
|
|
|
|
|
// page := (msg >> 12) & 0x04
|
|
|
|
|
// x := (msg >> 6) & 0x4F
|
|
|
|
|
// len := (msg >> 0) & 0x4F
|
|
|
|
|
//
|
|
|
|
|
// }
|
|
|
|
|
// }
|
|
|
|
|
return d.dev.Close()
|
|
|
|
|
}
|
|
|
|
|