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

Add: error handling

Browse Source
This commit is contained in:
Andrey Egorov 2024-08-29 22:03:56 +03:00
parent 0e9d7cabac
commit ccbae16a7b
3 changed files with 187 additions and 189 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

92
display/mt-12864a.go
View File

@ -22,14 +22,104 @@ func newMt12864a(logger *log.Logger) (Display, error) {
return nil, fmt.Errorf("mt12864 create: %w", err) 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{ d := displayMt12864a{
logger: logger, logger: logger,
dev: dev, dev: dev,
} }
// Temp debug draw
d.test()
return &d, nil 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 { func (d *displayMt12864a) GetBounds() image.Rectangle {
return image.Rectangle{} return image.Rectangle{}
} }

5
main.go
View File

@ -162,7 +162,10 @@ func MainLoop(ctx context.Context) error {
func mainE(ctx context.Context) error { func mainE(ctx context.Context) error {
logger = log.New(os.Stdout, "main : ", log.LstdFlags) 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) time.Sleep(2 * time.Second)
defer disp.Close() defer disp.Close()
// if err := Init(ctx); err != nil { // if err := Init(ctx); err != nil {

279
pkg/mt12864a/mt12864a.go
View File

@ -1,6 +1,7 @@
package mt12864a package mt12864a
import ( import (
"fmt"
"io" "io"
"log" "log"
"time" "time"
@ -36,22 +37,17 @@ type mt12864a struct {
} }
type Device interface { type Device interface {
PowerOn() PowerOn() error
SetPixel(x, y byte, c bool) error
WriteCodeL(c byte) WriteCodeL(c byte) error
WriteCodeR(c byte) WriteCodeR(c byte) error
WriteDataL(b byte) error
WriteDataR(b byte) error
WriteDataL(b byte) ReadDataL() (byte, error)
WriteDataR(b byte) ReadDataR() (byte, error)
ReadStatus(l, r rpio.State) byte
WriteDataArrayL(b []byte)
WriteDataArrayR(b []byte)
ReadDataL() byte
ReadDataR() byte
ReadDataArrayL() []byte
ReadDataArrayR() []byte
io.Closer io.Closer
} }
@ -97,59 +93,32 @@ func (d *mt12864a) Close() error {
return rpio.Close() return rpio.Close()
} }
// func (d *mt12864a) SetPixel() { func (d *mt12864a) SetPixel(x, y byte, c bool) error {
// // var c8 byte
// } // var mask byte
/* // Check bounds
void Pset(byte x, byte y, bit c) {//Записать одну точку в индикатор (координата 0,0 в левом верхнем углу индикатора) if x > 127 || y > 63 {
byte c8;//Временное хранение считаного из индикатора байта return fmt.Errorf("positions out of bounds")
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);//Записать изменённый байт обратно в индикатор
} }
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() {
// 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()
func (d *mt12864a) PowerOn() error {
d.pinA0.Low() d.pinA0.Low()
d.pinRW.Low() d.pinRW.Low()
d.pinE.Low() d.pinE.Low()
@ -180,74 +149,53 @@ func (d *mt12864a) PowerOn() {
d.PrintPins() d.PrintPins()
d.logger.Println("Display on") d.logger.Println("Display on")
d.WriteCodeL(0x3F) // Display on d.WriteCodeL(0x3F) // Display on
d.waitReady(1, 0)
d.waitReady(0, 1)
d.WriteCodeR(0x3F) // Display on d.WriteCodeR(0x3F) // Display on
d.waitReady(1, 0)
d.waitReady(0, 1)
d.PrintPins() d.PrintPins()
return nil
} }
// Write codes // Write codes
func (d *mt12864a) WriteCodeL(c byte) { func (d *mt12864a) WriteCodeL(c byte) error {
d.writeByte(c, 0, 1, 0) return d.writeByte(c, 0, 1, 0)
} }
func (d *mt12864a) WriteCodeR(c byte) { func (d *mt12864a) WriteCodeR(c byte) error {
d.writeByte(c, 0, 0, 1) return d.writeByte(c, 0, 0, 1)
} }
// Write data as byte // Write data as byte
func (d *mt12864a) WriteDataL(b byte) { func (d *mt12864a) WriteDataL(b byte) error {
d.writeByte(b, 1, 1, 0) return d.writeByte(b, 1, 1, 0)
} }
func (d *mt12864a) WriteDataR(b byte) { func (d *mt12864a) WriteDataR(b byte) error {
d.writeByte(b, 1, 0, 1) return 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)
} }
// Read data // Read data
func (d *mt12864a) ReadDataL() byte { func (d *mt12864a) ReadDataL() (byte, error) {
return d.readByte(1, 1, 0) return d.readByte(1, 1, 0)
} }
func (d *mt12864a) ReadDataR() byte { func (d *mt12864a) ReadDataR() (byte, error) {
return d.readByte(1, 0, 1) 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 // 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) d.logger.Println("Write byte", b, cd, l, r)
if l == rpio.High && r == rpio.High { if l == rpio.High && r == rpio.High {
d.logger.Println("L and R are 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.busOutput()
d.pinRW.Low() // We write d.pinRW.Low() // We write
d.pinA0.Write(cd) d.pinA0.Write(cd)
@ -267,6 +215,7 @@ func (d *mt12864a) writeByte(b byte, cd, l, r rpio.State) {
// Strobe start // Strobe start
d.pinE.High() d.pinE.High()
time.Sleep(dataStrobeTimeout) time.Sleep(dataStrobeTimeout)
// Strobe end // Strobe end
d.pinE.Low() d.pinE.Low()
d.pinDB0.Low() d.pinDB0.Low()
@ -278,60 +227,20 @@ func (d *mt12864a) writeByte(b byte, cd, l, r rpio.State) {
d.pinDB6.Low() d.pinDB6.Low()
d.pinDB7.Low() d.pinDB7.Low()
time.Sleep(time.Millisecond - dataStrobeTimeout - adressWriteTimeout) time.Sleep(time.Millisecond - dataStrobeTimeout - adressWriteTimeout)
return nil
} }
func (d *mt12864a) writeByteArray(b []byte, cd, l, r rpio.State) { func (d *mt12864a) readByte(cd, l, r rpio.State) (byte, error) {
d.logger.Println("Write byte", b, cd, l, r)
if len(b) != 8 {
d.logger.Println("invalid b len")
return
}
if l == rpio.High && r == rpio.High { if l == rpio.High && r == rpio.High {
d.logger.Println("L and R are 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 { // Setup
if l == rpio.High && r == rpio.High {
d.logger.Println("L and R are high!!!")
return 0
}
var b byte var b byte
if err := d.waitReady(l, r); err != nil {
d.waitReady(l, r) return 0, fmt.Errorf("wait ready: %w", err)
}
d.busOutput() d.busOutput()
d.pinRW.High() // We write d.pinRW.High() // We write
d.pinA0.Write(cd) d.pinA0.Write(cd)
@ -355,73 +264,69 @@ func (d *mt12864a) readByte(cd, l, r rpio.State) byte {
// Strobe end // Strobe end
d.pinE.Low() d.pinE.Low()
time.Sleep(time.Millisecond - dataStrobeTimeout - adressWriteTimeout) time.Sleep(time.Millisecond - dataStrobeTimeout - adressWriteTimeout)
return b return b, nil
} }
func (d *mt12864a) readByteArray(cd, l, r rpio.State) []byte { // Wait, checking status byte
if l == rpio.High && r == rpio.High { func (d *mt12864a) waitReady(l, r rpio.State) error {
d.logger.Println("L and R are high!!!") d.logger.Println("Wait ready", l, r)
return nil d.busInput() // Set bus to input
} d.pinRW.High() // We read
b := make([]byte, 8) d.pinA0.Low() // Status
d.waitReady(l, r)
d.busOutput()
d.pinRW.High() // We write
d.pinA0.Write(cd)
d.pinE1.Write(l) // Select cristals d.pinE1.Write(l) // Select cristals
d.pinE2.Write(r) // Select cristals d.pinE2.Write(r) // Select cristals
time.Sleep(adressWriteTimeout)
// Strobe start // Strobe start
d.pinE.High() d.pinE.High()
time.Sleep(dataStrobeTimeout) time.Sleep(dataStrobeTimeout)
// Read // Wait status flag drop
b[0] = (uint8(d.pinDB0.Read()) << 0) ok := false
b[1] = (uint8(d.pinDB1.Read()) << 1) d.busInput() // Set bus to input
b[2] = (uint8(d.pinDB2.Read()) << 2) for counter := 0; counter < maxWaitCycles; counter++ {
b[3] = (uint8(d.pinDB3.Read()) << 3) if d.pinDB7.Read() != rpio.High {
b[4] = (uint8(d.pinDB4.Read()) << 4) 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())
b[5] = (uint8(d.pinDB5.Read()) << 5) ok = true
b[6] = (uint8(d.pinDB6.Read()) << 6) break
b[7] = (uint8(d.pinDB7.Read()) << 7) }
}
if !ok {
return fmt.Errorf("busy timeout")
}
// Strobe end // Strobe end
d.pinE.Low() d.pinE.Low()
time.Sleep(time.Millisecond - dataStrobeTimeout - adressWriteTimeout) time.Sleep(time.Millisecond - dataStrobeTimeout - adressWriteTimeout)
d.logger.Println("Ready")
return nil return nil
} }
// Wait, checking status byte func (d *mt12864a) ReadStatus(l, r rpio.State) byte {
func (d *mt12864a) waitReady(l, r rpio.State) {
d.logger.Println("Wait ready", l, r)
d.busInput() // Set bus to input d.busInput() // Set bus to input
d.pinRW.High() // We read d.pinRW.High() // We read
d.pinA0.Low() // Data d.pinA0.Low() // Status
d.pinE1.Write(l) // Select cristals d.pinE1.Write(l) // Select cristals
d.pinE2.Write(r) // Select cristals d.pinE2.Write(r) // Select cristals
time.Sleep(adressWriteTimeout) time.Sleep(adressWriteTimeout)
// Strobe start // Strobe start
d.pinE.High() d.pinE.High()
time.Sleep(dataStrobeTimeout) time.Sleep(dataStrobeTimeout)
// Wait status flag drop d.busInput()
counter := 0
for counter < maxWaitCycles { var b byte = uint8(d.pinDB0.Read()) |
d.busInput() // Set bus to input (uint8(d.pinDB1.Read()) << 1) |
if d.pinDB7.Read() != rpio.High { (uint8(d.pinDB2.Read()) << 2) |
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()) (uint8(d.pinDB3.Read()) << 3) |
break (uint8(d.pinDB4.Read()) << 4) |
} (uint8(d.pinDB5.Read()) << 5) |
d.PrintPins() (uint8(d.pinDB6.Read()) << 6) |
counter++ (uint8(d.pinDB7.Read()) << 7)
}
if counter == maxWaitCycles {
log.Println("TIMEOUT!!!!!!!!!!!!!")
}
// Strobe end // Strobe end
d.pinE.Low() d.pinE.Low()
time.Sleep(time.Millisecond - dataStrobeTimeout - adressWriteTimeout) time.Sleep(time.Millisecond - dataStrobeTimeout - adressWriteTimeout)
d.logger.Println("Ready") return b
} }
func (d *mt12864a) PrintPins() { func (d *mt12864a) PrintPins() {