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
Download Patch File Download Diff File Expand all files Collapse all files

279
pkg/mt12864a/mt12864a.go
View File

@ -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() {