yotia/display-test
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

fix: error handling, timeouts

Browse Source
This commit is contained in:
Andrey Egorov
2024-09-09 10:31:36 +03:00
parent 7e41196dce
commit 8889e959ee
4 changed files with 209 additions and 159 deletions
Download Patch File Download Diff File Expand all files Collapse all files

178
display/mt-12232a.go
View File

@ -1,10 +1,10 @@
package display
import (
"context"
"fmt"
"image"
"log"
"math/rand"
"time"
"gitea.unprism.ru/yotia/display-test/pkg/mt12232a"
@ -16,6 +16,16 @@ type displayMt12232a struct {
// 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) {
@ -33,30 +43,116 @@ func newMt12232a(logger *log.Logger) (Display, error) {
// return nil, fmt.Errorf("power on: %w", err)
// }
// Setup submit goroutine
ctx, cancel := context.WithCancel(context.Background())
d := displayMt12232a{
logger: logger,
dev: dev,
logger: logger,
dev: dev,
submitCtx: ctx,
submitCtxCancel: cancel,
}
defer d.submitLoop()
// Temp debug draw
d.logger.Println(d.dev.ReadStatus(0)&0xF0, d.dev.ReadStatus(1)&0xF0)
//d.logger.Println("Draw...")
//d.test()
//d.logger.Println("Draw finished")
d.status("start")
if err := d.dev.Reset(); err != nil {
return nil, fmt.Errorf("reset: %w", err)
}
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")
return &d, nil
}
func (d *displayMt12232a) status(label string) {
d.logger.Printf("STATUS %s -- L: %08b R: %08b\n", label, d.dev.ReadStatus(0)&0xFF, d.dev.ReadStatus(1)&0xFF)
}
func (d *displayMt12232a) powerOn() error {
d.logger.Println("Power on")
if err := d.dev.WriteCode(0, 0xE2); err != nil { // Reset
return fmt.Errorf("reset: %w", err)
}
d.status("1L")
if err := d.dev.WriteCode(1, 0xE2); err != nil { // Reset
return fmt.Errorf("reset: %w", err)
}
d.status("1R")
if err := d.dev.WriteCode(0, 0xEE); err != nil { // ReadModifyWrite off
return fmt.Errorf("RMW off: %w", err)
}
d.status("2L")
if err := d.dev.WriteCode(1, 0xEE); err != nil { // ReadModifyWrite off
return fmt.Errorf("RMW off: %w", err)
}
d.status("2R")
if err := d.dev.WriteCode(0, 0xA4); err != nil { // Turn on common mode
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
return fmt.Errorf("turn on common mode: %w", err)
}
d.status("3R")
if err := d.dev.WriteCode(0, 0xA9); err != nil { // Multiplex 1/32
return fmt.Errorf("multiplex 1/32: %w", err)
}
d.status("4L")
if err := d.dev.WriteCode(1, 0xA9); err != nil { // Multiplex 1/32
return fmt.Errorf("multiplex 1/32: %w", err)
}
d.status("4R")
if err := d.dev.WriteCode(0, 0xC0); err != nil { // Top line to 0
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
return fmt.Errorf("top line to 0: %w", err)
}
d.status("5R")
if err := d.dev.WriteCode(0, 0xA0); err != nil { // Invert scan RAM
return fmt.Errorf("inver scan RAM: %w", err)
}
d.status("6L")
if err := d.dev.WriteCode(1, 0xA0); err != nil { // Invert scan RAM
return fmt.Errorf("inver scan RAM: %w", err)
}
d.status("6R")
if err := d.dev.WriteCode(0, 0xAF); err != nil { // Display on
return fmt.Errorf("display on: %w", err)
}
d.status("7L")
if err := d.dev.WriteCode(1, 0xAF); err != nil { // Display on
return fmt.Errorf("display on: %w", err)
}
d.status("7R")
//time.Sleep(time.Second)
// Check that crystals are turned on
// The same but with error
if d.dev.ReadStatus(0)&0x20 != 0 {
return fmt.Errorf("Left cristal is off")
}
return nil
}
func (d *displayMt12232a) test() {
d.logger.Println("Write")
d.dev.WriteCodeL(0xB8)
d.dev.WriteCodeL(0x13)
d.dev.WriteDataL(47)
d.dev.WriteCode(0, 0xB8)
d.dev.WriteCode(0, 0x00)
d.dev.WriteData(0, 47)
d.logger.Println("Read")
// d.dev.WriteCodeL(0xB8)
d.dev.WriteCodeL(0x13)
d.logger.Println(d.dev.ReadDataL())
d.logger.Println(d.dev.ReadDataL())
d.dev.WriteCode(0, 0xB8)
d.dev.WriteCode(0, 0x00)
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}
@ -87,18 +183,26 @@ 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")
for p := byte(0); p < 4; p++ {
d.dev.WriteCodeL(p | 0xB8)
d.dev.WriteCodeL(0x13)
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.WriteDatasL([]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.WriteCodeR(p | 0xB8)
d.dev.WriteCodeR(0x00)
for c := 0; c < 61; c++ {
d.dev.WriteDatasR([]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{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.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")
end := time.Now()
d.logger.Println(end.Sub(start))
// for p := byte(0); p < 8; p++ {
@ -124,10 +228,10 @@ func (d *displayMt12232a) GetBounds() image.Rectangle {
func (d *displayMt12232a) Flush(img *image.Gray) error {
for p := byte(0); p < 4; p++ {
d.dev.WriteCodeL((3 - p) | 0xB8)
d.dev.WriteCodeL(0x13)
d.dev.WriteCode(0, (3-p)|0xB8)
d.dev.WriteCode(0, 0x13)
for c := 0; c < 61; c++ {
d.dev.WriteDatasL([]byte{
d.dev.WriteDatas(0, []byte{
img.Pix[int(p<<3+7)*122+c],
img.Pix[int(p<<3+6)*122+c],
img.Pix[int(p<<3+5)*122+c],
@ -138,10 +242,10 @@ func (d *displayMt12232a) Flush(img *image.Gray) error {
img.Pix[int(p<<3+0)*122+c],
})
}
d.dev.WriteCodeR((3 - p) | 0xB8)
d.dev.WriteCodeR(0x00)
d.dev.WriteCode(1, (3-p)|0xB8)
d.dev.WriteCode(1, 0x00)
for c := 61; c < 122; c++ {
d.dev.WriteDatasR([]byte{
d.dev.WriteDatas(1, []byte{
img.Pix[int(p<<3+7)*122+c],
img.Pix[int(p<<3+6)*122+c],
img.Pix[int(p<<3+5)*122+c],
@ -157,5 +261,23 @@ 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
//
// }
// }
}