Add: error handling
This commit is contained in:
Andrey Egorov
parent
0e9d7cabac
commit
ccbae16a7b
@ -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{}
|
||||
}
|
||||
|
||||
5
main.go
5
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 {
|
||||
|
||||
@ -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")
|
||||
}
|
||||
|
||||
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
|
||||
}
|
||||
*/
|
||||
|
||||
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()
|
||||
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() {
|
||||
|
||||
Loading…
Reference in New Issue
Block a user