From ccbae16a7bcaefab2451a4593c0d7aad2e2a9bf6 Mon Sep 17 00:00:00 2001 From: Andrey Egorov Date: Thu, 29 Aug 2024 22:03:56 +0300 Subject: [PATCH] Add: error handling --- display/mt-12864a.go | 92 ++++++++++++- main.go | 5 +- pkg/mt12864a/mt12864a.go | 279 +++++++++++++-------------------------- 3 files changed, 187 insertions(+), 189 deletions(-) diff --git a/display/mt-12864a.go b/display/mt-12864a.go index 641dd25..e9d7e13 100644 --- a/display/mt-12864a.go +++ b/display/mt-12864a.go @@ -22,14 +22,104 @@ func newMt12864a(logger *log.Logger) (Display, error) { return nil, fmt.Errorf("mt12864 create: %w", err) } - dev.PowerOn() + if err := dev.PowerOn(); err != nil { + return nil, fmt.Errorf("power on: %w", err) + } + d := displayMt12864a{ logger: logger, dev: dev, } + + // Temp debug draw + d.test() + return &d, nil } +func (d *displayMt12864a) test() { + //d.SetPixel(4, 10, true) + Logo128 := [][]byte{[]byte{0xFF, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, + 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, + 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, + 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, + 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, + 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, + 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, + 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0x01, 0xFF, + }, []byte{0xFF, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x80, 0xC0, 0xE0, 0xC0, 0xE0, 0xF0, 0xF0, 0xF0, + 0xF0, 0xF0, 0xF0, 0xF0, 0xF0, 0xF0, 0xF0, 0xF0, 0xF0, 0xF0, 0xE0, 0xE0, 0xE0, 0xC0, 0x80, 0x00, + 0x00, 0x00, 0x00, 0x80, 0x00, 0x00, 0x00, 0x80, 0x00, 0x80, 0x00, 0x80, 0x00, 0x80, 0x00, 0x80, + 0x00, 0x80, 0x80, 0x00, 0x00, 0x80, 0x00, 0x00, 0x80, 0x00, 0x00, 0x00, 0x00, 0x80, 0x00, 0x00, + 0x80, 0x00, 0x00, 0x80, 0x00, 0x80, 0x00, 0x80, 0x80, 0x80, 0x00, 0x80, 0x80, 0x00, 0x00, 0x80, + 0x00, 0x00, 0x80, 0x00, 0x80, 0x00, 0x80, 0x00, 0x80, 0x00, 0x80, 0x00, 0x80, 0x00, 0x80, 0x00, + 0x00, 0x00, 0x80, 0x00, 0x80, 0x00, 0x00, 0x80, 0x80, 0x80, 0x00, 0x80, 0x00, 0x00, 0x80, 0x00, + 0x80, 0x00, 0x80, 0x00, 0x80, 0x00, 0x80, 0x00, 0x80, 0x00, 0x80, 0x00, 0x80, 0x00, 0x80, 0x3F, + }, []byte{0x1F, 0xC0, 0xE0, 0xE0, 0xFC, 0xFE, 0xF3, 0xE3, 0xE3, 0xE3, 0xE3, 0xAF, 0x6F, 0xFF, 0xFF, 0xFF, + 0xBF, 0xBF, 0xFF, 0xFF, 0x7F, 0x7F, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, + 0xFF, 0xF6, 0xF4, 0x1F, 0x21, 0xE2, 0x61, 0x6F, 0x60, 0x6F, 0x64, 0x6F, 0x60, 0x6F, 0x65, 0x68, + 0x60, 0x6F, 0x62, 0x61, 0x67, 0x68, 0x67, 0x60, 0x6A, 0x67, 0x60, 0x6E, 0x61, 0x6F, 0x60, 0x67, + 0x6A, 0x6B, 0x60, 0x6F, 0x65, 0x68, 0x60, 0x60, 0x6F, 0x60, 0x60, 0x6F, 0x62, 0x61, 0x67, 0x68, + 0x67, 0x60, 0x6F, 0x62, 0x6F, 0x60, 0x6F, 0x64, 0x6F, 0x60, 0x6F, 0x65, 0x68, 0x64, 0x6A, 0x6F, + 0x60, 0x60, 0x6F, 0x64, 0x6F, 0x60, 0x60, 0x60, 0x6F, 0x60, 0x67, 0x6A, 0x6B, 0x60, 0x6D, 0x62, + 0x6D, 0x60, 0x6F, 0x62, 0x6F, 0x60, 0x6F, 0x64, 0x6F, 0x60, 0x6F, 0x65, 0x68, 0x64, 0x6A, 0x6F, + }, []byte{0xFE, 0x3F, 0x3F, 0x3F, 0xBF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0xFE, 0xF9, 0x77, 0x37, + 0x03, 0x03, 0x01, 0x00, 0x00, 0x00, 0x00, 0x01, 0x07, 0x0F, 0x13, 0x01, 0x00, 0x00, 0x01, 0x07, + 0xD7, 0x0E, 0x08, 0xC0, 0x00, 0x10, 0x0F, 0xF8, 0x00, 0x00, 0x80, 0xE0, 0xF8, 0xFE, 0xFF, 0xFF, + 0xFF, 0xFE, 0x00, 0x00, 0x00, 0x00, 0x00, 0xC0, 0xF0, 0xFE, 0xFF, 0xFF, 0xFF, 0xFE, 0x00, 0x00, + 0x00, 0xE0, 0xF0, 0xF8, 0xFC, 0x7C, 0x3E, 0x1E, 0x1F, 0x0F, 0x0F, 0x0F, 0x0F, 0x1F, 0x1E, 0x1E, + 0x3E, 0x7C, 0xFC, 0xF8, 0xF0, 0xC0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x80, 0xC0, 0xF0, 0xFC, 0xFE, 0xFF, 0xFF, 0xFE, 0x00, 0x00, 0x06, 0x0F, 0x0F, 0x0F, 0x0F, 0x0F, + 0x0F, 0x0F, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x0F, 0x0F, 0x0F, 0x0F, 0x0F, 0x0F, 0x0F, 0x06, 0xF0, + }, []byte{0x3F, 0xE0, 0x00, 0x00, 0x01, 0x3F, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x3F, 0x3F, 0x00, 0x00, 0xE0, + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x01, 0x01, 0xC1, 0xE0, 0xE0, 0xF9, 0xFF, 0xFC, 0xFF, 0xFF, 0x7F, 0x1F, 0xFF, 0xFF, 0xFF, + 0xFF, 0xFF, 0x80, 0xE0, 0xF8, 0xFE, 0xFF, 0xFF, 0x3F, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x00, 0x00, + 0x00, 0x00, 0x01, 0x01, 0x00, 0x00, 0x00, 0x30, 0x78, 0x78, 0xFC, 0xFC, 0xFC, 0xFC, 0x78, 0x78, + 0x30, 0x00, 0x01, 0x07, 0xFF, 0xFF, 0xFF, 0xFC, 0x00, 0x00, 0x00, 0x00, 0x80, 0xE0, 0xF8, 0xFE, + 0xFF, 0xFF, 0x3F, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xFF, + }, []byte{0xFC, 0x01, 0x03, 0x04, 0x18, 0x20, 0x40, 0x81, 0x87, 0x07, 0x07, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x80, + 0x80, 0xE4, 0xE7, 0xFB, 0xFF, 0xFF, 0x7F, 0x3F, 0x0F, 0x03, 0x01, 0x00, 0x00, 0xFF, 0xFF, 0xFF, + 0xFF, 0xFF, 0xFF, 0x7F, 0x1F, 0x07, 0x03, 0x00, 0x00, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x00, 0x00, + 0x00, 0x70, 0xF8, 0xF8, 0xF0, 0xE0, 0xE0, 0xC0, 0xC0, 0x80, 0x80, 0x80, 0x80, 0xC0, 0xC0, 0xC0, + 0xE0, 0xF0, 0xFC, 0xFF, 0x7F, 0x3F, 0x0F, 0x81, 0xE0, 0xF8, 0xFC, 0xFF, 0xFF, 0x3F, 0x1F, 0x07, + 0x01, 0x00, 0x00, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0xFF, 0xFF, 0xFF, 0xFF, 0xFF, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xFF, + }, []byte{0xFF, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x01, 0x02, 0x02, 0x04, 0x04, 0x04, 0x0C, + 0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x0C, 0x04, 0x04, 0x04, 0x02, 0x03, 0x01, 0x00, + 0x00, 0x03, 0x07, 0x07, 0x03, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x03, 0x07, 0x07, + 0x07, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x03, 0x07, 0x07, 0x07, 0x03, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x01, 0x01, 0x03, 0x03, 0x03, 0x07, 0x07, 0x07, 0x07, 0x07, 0x07, 0x03, 0x03, + 0x03, 0x01, 0x01, 0x00, 0x00, 0x00, 0x00, 0x03, 0x07, 0x07, 0x07, 0x03, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x00, 0x03, 0x07, 0x07, 0x07, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, + 0x00, 0x00, 0x03, 0x07, 0x07, 0x07, 0x03, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0xFF, + }, []byte{0xFF, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, + 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, + 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, + 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, + 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, + 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, + 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, + 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0x80, 0xFF, + }, + } + + for p := byte(0); p < 8; p++ { + d.dev.WriteCodeL(p | 0xB8) + d.dev.WriteCodeL(0x40) + for c := 0; c < 64; c++ { + d.dev.WriteDataL(Logo128[p][c]) + } + d.dev.WriteCodeR(p | 0xB8) + d.dev.WriteCodeR(0x40) + for c := 64; c < 128; c++ { + d.dev.WriteDataR(Logo128[p][c]) + } + } +} + func (d *displayMt12864a) GetBounds() image.Rectangle { return image.Rectangle{} } diff --git a/main.go b/main.go index 360a994..5d53078 100644 --- a/main.go +++ b/main.go @@ -162,7 +162,10 @@ func MainLoop(ctx context.Context) error { func mainE(ctx context.Context) error { logger = log.New(os.Stdout, "main : ", log.LstdFlags) // - disp, _ := display.New(logger, display.MT12864A) + disp, err := display.New(logger, display.MT12864A) + if err != nil { + return err + } time.Sleep(2 * time.Second) defer disp.Close() // if err := Init(ctx); err != nil { diff --git a/pkg/mt12864a/mt12864a.go b/pkg/mt12864a/mt12864a.go index e3bee1d..034126f 100644 --- a/pkg/mt12864a/mt12864a.go +++ b/pkg/mt12864a/mt12864a.go @@ -1,6 +1,7 @@ package mt12864a import ( + "fmt" "io" "log" "time" @@ -36,22 +37,17 @@ type mt12864a struct { } type Device interface { - PowerOn() + PowerOn() error + SetPixel(x, y byte, c bool) error - WriteCodeL(c byte) - WriteCodeR(c byte) + WriteCodeL(c byte) error + WriteCodeR(c byte) error + WriteDataL(b byte) error + WriteDataR(b byte) error - WriteDataL(b byte) - WriteDataR(b byte) - - WriteDataArrayL(b []byte) - WriteDataArrayR(b []byte) - - ReadDataL() byte - ReadDataR() byte - - ReadDataArrayL() []byte - ReadDataArrayR() []byte + ReadDataL() (byte, error) + ReadDataR() (byte, error) + ReadStatus(l, r rpio.State) byte io.Closer } @@ -97,59 +93,32 @@ func (d *mt12864a) Close() error { return rpio.Close() } -// func (d *mt12864a) SetPixel() { -// -// } +func (d *mt12864a) SetPixel(x, y byte, c bool) error { + // var c8 byte + // var mask byte -/* -void Pset(byte x, byte y, bit c) {//Записать одну точку в индикатор (координата 0,0 в левом верхнем углу индикатора) - byte c8;//Временное хранение считаного из индикатора байта - byte m8;//Маска нужного бита в байте - if ((x>127)||(y>63)) return;//Выход за пределы индикатора - if (x<64) {//Выводить в левую половину индикатора - WriteCodeL(0xB8|(y>>3));//Установить нужную страницу индикатора - WriteCodeL(0x40|x);//Установить адрес нужного байта - c8=ReadDataL();//Фиктивное чтение - c8=ReadDataL();//Чтение нужного байта из индикатора - m8=1<<(y&0x07);//Вычислить маску нужного бита в байте - if (c==1) //Зажигать точку? - c8|=m8//Установить нужный бит в байте - else //Или гасить точку? - c8&=~m8;//Сбросить нужный бит в байте - WriteCodeL(0x40|x);//Снова установить адрес нужного байта - WriteDataL(c8);//Записать изменённый байт обратно в индикатор - } else {//Выводить в правую половину индикатора - WriteCodeR(0xB8|(y>>3));//Установить нужную страницу индикатора - WriteCodeR(0x40|(x-64));//Установить адрес нужного байта - c8=ReadDataR();//Фиктивное чтение - c8=ReadDataR();//Чтение нужного байта из индикатора - m8=1<<(y&0x07);//Вычислить маску нужного бита в байте - if (c==1) //Зажигать точку? - c8|=m8//Установить нужный бит в байте - else //Или гасить точку? - c8&=~m8;//Сбросить нужный бит в байте - WriteCodeR(0x40|(x-64));//Снова установить адрес нужного байта - WriteDataR(c8);//Записать изменённый байт обратно в индикатор - } + // Check bounds + if x > 127 || y > 63 { + return fmt.Errorf("positions out of bounds") } -*/ -func (d *mt12864a) PowerOn() { - // d.pinA0.PullOff() - // d.pinRW.PullOff() - // d.pinE.PullOff() - // d.pinDB0.PullOff() - // d.pinDB1.PullOff() - // d.pinDB2.PullOff() - // d.pinDB3.PullOff() - // d.pinDB4.PullOff() - // d.pinDB5.PullOff() - // d.pinDB6.PullOff() - // d.pinDB7.PullOff() - // d.pinE1.PullOff() - // d.pinE2.PullOff() - // d.pinRES.PullOff() + if x < 64 { // Left crystal + d.WriteCodeL(0xB8 | (y >> 3)) // Set page + d.WriteCodeL(0x40 | x) // Set addr + // c8=ReadDataL(); // ?? ok + // c8=ReadDataL(); // Read byte + // m8=1<<(y&0x07);//Вычислить маску нужного бита в байте + // if (c==1) //Зажигать точку? + // c8|=m8//Установить нужный бит в байте + // else //Или гасить точку? + // c8&=~m8;//Сбросить нужный бит в байте + // WriteCodeL(0x40|x);//Снова установить адрес нужного байта + d.WriteDataL(0x34) // Write byte + } + return nil +} +func (d *mt12864a) PowerOn() error { d.pinA0.Low() d.pinRW.Low() d.pinE.Low() @@ -180,74 +149,53 @@ func (d *mt12864a) PowerOn() { d.PrintPins() d.logger.Println("Display on") d.WriteCodeL(0x3F) // Display on - d.waitReady(1, 0) - d.waitReady(0, 1) d.WriteCodeR(0x3F) // Display on - d.waitReady(1, 0) - d.waitReady(0, 1) d.PrintPins() + return nil } // Write codes -func (d *mt12864a) WriteCodeL(c byte) { - d.writeByte(c, 0, 1, 0) +func (d *mt12864a) WriteCodeL(c byte) error { + return d.writeByte(c, 0, 1, 0) } -func (d *mt12864a) WriteCodeR(c byte) { - d.writeByte(c, 0, 0, 1) +func (d *mt12864a) WriteCodeR(c byte) error { + return d.writeByte(c, 0, 0, 1) } // Write data as byte -func (d *mt12864a) WriteDataL(b byte) { - d.writeByte(b, 1, 1, 0) +func (d *mt12864a) WriteDataL(b byte) error { + return d.writeByte(b, 1, 1, 0) } -func (d *mt12864a) WriteDataR(b byte) { - d.writeByte(b, 1, 0, 1) -} - -// Write data as byte array - -func (d *mt12864a) WriteDataArrayL(b []byte) { - d.writeByteArray(b, 1, 1, 0) -} - -func (d *mt12864a) WriteDataArrayR(b []byte) { - d.writeByteArray(b, 1, 0, 1) +func (d *mt12864a) WriteDataR(b byte) error { + return d.writeByte(b, 1, 0, 1) } // Read data -func (d *mt12864a) ReadDataL() byte { +func (d *mt12864a) ReadDataL() (byte, error) { return d.readByte(1, 1, 0) } -func (d *mt12864a) ReadDataR() byte { +func (d *mt12864a) ReadDataR() (byte, error) { return d.readByte(1, 0, 1) } -// Read data array - -func (d *mt12864a) ReadDataArrayL() []byte { - return d.readByteArray(1, 1, 0) -} - -func (d *mt12864a) ReadDataArrayR() []byte { - return d.readByteArray(1, 0, 1) -} - // Low level functions -func (d *mt12864a) writeByte(b byte, cd, l, r rpio.State) { +func (d *mt12864a) writeByte(b byte, cd, l, r rpio.State) error { d.logger.Println("Write byte", b, cd, l, r) if l == rpio.High && r == rpio.High { d.logger.Println("L and R are high!!!") - return + return fmt.Errorf("cannot write left and right at the same times") + } + if err := d.waitReady(l, r); err != nil { + return fmt.Errorf("wait ready: %w", err) } - d.waitReady(l, r) d.busOutput() d.pinRW.Low() // We write d.pinA0.Write(cd) @@ -267,6 +215,7 @@ func (d *mt12864a) writeByte(b byte, cd, l, r rpio.State) { // Strobe start d.pinE.High() time.Sleep(dataStrobeTimeout) + // Strobe end d.pinE.Low() d.pinDB0.Low() @@ -278,60 +227,20 @@ func (d *mt12864a) writeByte(b byte, cd, l, r rpio.State) { d.pinDB6.Low() d.pinDB7.Low() time.Sleep(time.Millisecond - dataStrobeTimeout - adressWriteTimeout) + return nil } -func (d *mt12864a) writeByteArray(b []byte, cd, l, r rpio.State) { - d.logger.Println("Write byte", b, cd, l, r) - if len(b) != 8 { - d.logger.Println("invalid b len") - return - } +func (d *mt12864a) readByte(cd, l, r rpio.State) (byte, error) { if l == rpio.High && r == rpio.High { d.logger.Println("L and R are high!!!") - return + return 0, fmt.Errorf("cannot ready left and right at the same time") } - d.waitReady(l, r) - d.busOutput() - d.pinRW.Low() // We write - d.pinA0.Write(cd) - d.pinE1.Write(l) // Select cristals - d.pinE2.Write(r) // Select cristals - // Write bus - d.pinDB0.Write(rpio.State(b[0])) - d.pinDB1.Write(rpio.State(b[1])) - d.pinDB2.Write(rpio.State(b[2])) - d.pinDB3.Write(rpio.State(b[3])) - d.pinDB4.Write(rpio.State(b[4])) - d.pinDB5.Write(rpio.State(b[5])) - d.pinDB6.Write(rpio.State(b[6])) - d.pinDB7.Write(rpio.State(b[7])) - - // Strobe start - d.pinE.High() - time.Sleep(dataStrobeTimeout) - // Strobe end - d.pinE.Low() - d.pinDB0.Low() - d.pinDB1.Low() - d.pinDB2.Low() - d.pinDB3.Low() - d.pinDB4.Low() - d.pinDB5.Low() - d.pinDB6.Low() - d.pinDB7.Low() - - time.Sleep(time.Millisecond - dataStrobeTimeout - adressWriteTimeout) -} - -func (d *mt12864a) readByte(cd, l, r rpio.State) byte { - if l == rpio.High && r == rpio.High { - d.logger.Println("L and R are high!!!") - return 0 - } + // Setup var b byte - - d.waitReady(l, r) + if err := d.waitReady(l, r); err != nil { + return 0, fmt.Errorf("wait ready: %w", err) + } d.busOutput() d.pinRW.High() // We write d.pinA0.Write(cd) @@ -355,73 +264,69 @@ func (d *mt12864a) readByte(cd, l, r rpio.State) byte { // Strobe end d.pinE.Low() time.Sleep(time.Millisecond - dataStrobeTimeout - adressWriteTimeout) - return b + return b, nil } -func (d *mt12864a) readByteArray(cd, l, r rpio.State) []byte { - if l == rpio.High && r == rpio.High { - d.logger.Println("L and R are high!!!") - return nil - } - b := make([]byte, 8) - - d.waitReady(l, r) - d.busOutput() - d.pinRW.High() // We write - d.pinA0.Write(cd) +// Wait, checking status byte +func (d *mt12864a) waitReady(l, r rpio.State) error { + d.logger.Println("Wait ready", l, r) + d.busInput() // Set bus to input + d.pinRW.High() // We read + d.pinA0.Low() // Status d.pinE1.Write(l) // Select cristals d.pinE2.Write(r) // Select cristals + time.Sleep(adressWriteTimeout) // Strobe start d.pinE.High() time.Sleep(dataStrobeTimeout) - // Read - b[0] = (uint8(d.pinDB0.Read()) << 0) - b[1] = (uint8(d.pinDB1.Read()) << 1) - b[2] = (uint8(d.pinDB2.Read()) << 2) - b[3] = (uint8(d.pinDB3.Read()) << 3) - b[4] = (uint8(d.pinDB4.Read()) << 4) - b[5] = (uint8(d.pinDB5.Read()) << 5) - b[6] = (uint8(d.pinDB6.Read()) << 6) - b[7] = (uint8(d.pinDB7.Read()) << 7) + // Wait status flag drop + ok := false + d.busInput() // Set bus to input + for counter := 0; counter < maxWaitCycles; counter++ { + if d.pinDB7.Read() != rpio.High { + d.logger.Printf("BUS:%d%d%d%d%d%d%d%d\n", d.pinDB0.Read(), d.pinDB1.Read(), d.pinDB2.Read(), d.pinDB3.Read(), d.pinDB4.Read(), d.pinDB5.Read(), d.pinDB6.Read(), d.pinDB7.Read()) + ok = true + break + } + } + if !ok { + return fmt.Errorf("busy timeout") + } // Strobe end d.pinE.Low() time.Sleep(time.Millisecond - dataStrobeTimeout - adressWriteTimeout) + d.logger.Println("Ready") return nil } -// Wait, checking status byte -func (d *mt12864a) waitReady(l, r rpio.State) { - d.logger.Println("Wait ready", l, r) +func (d *mt12864a) ReadStatus(l, r rpio.State) byte { d.busInput() // Set bus to input d.pinRW.High() // We read - d.pinA0.Low() // Data + d.pinA0.Low() // Status d.pinE1.Write(l) // Select cristals d.pinE2.Write(r) // Select cristals time.Sleep(adressWriteTimeout) // Strobe start d.pinE.High() time.Sleep(dataStrobeTimeout) - // Wait status flag drop - counter := 0 - for counter < maxWaitCycles { - d.busInput() // Set bus to input - if d.pinDB7.Read() != rpio.High { - d.logger.Printf("BUS:%d%d%d%d%d%d%d%d\n", d.pinDB0.Read(), d.pinDB1.Read(), d.pinDB2.Read(), d.pinDB3.Read(), d.pinDB4.Read(), d.pinDB5.Read(), d.pinDB6.Read(), d.pinDB7.Read()) - break - } - d.PrintPins() - counter++ - } - if counter == maxWaitCycles { - log.Println("TIMEOUT!!!!!!!!!!!!!") - } + d.busInput() + + var b byte = uint8(d.pinDB0.Read()) | + (uint8(d.pinDB1.Read()) << 1) | + (uint8(d.pinDB2.Read()) << 2) | + (uint8(d.pinDB3.Read()) << 3) | + (uint8(d.pinDB4.Read()) << 4) | + (uint8(d.pinDB5.Read()) << 5) | + (uint8(d.pinDB6.Read()) << 6) | + (uint8(d.pinDB7.Read()) << 7) + // Strobe end d.pinE.Low() time.Sleep(time.Millisecond - dataStrobeTimeout - adressWriteTimeout) - d.logger.Println("Ready") + return b } func (d *mt12864a) PrintPins() {