Add: beta working mt12232a display
This commit is contained in:
parent
c6af2620e0
commit
7e41196dce
@ -19,6 +19,7 @@ type DisplayModel int
|
|||||||
const (
|
const (
|
||||||
SSD1306 DisplayModel = iota
|
SSD1306 DisplayModel = iota
|
||||||
MT12864A
|
MT12864A
|
||||||
|
MT12232A
|
||||||
)
|
)
|
||||||
|
|
||||||
func New(logger *log.Logger, model DisplayModel) (Display, error) {
|
func New(logger *log.Logger, model DisplayModel) (Display, error) {
|
||||||
@ -27,6 +28,8 @@ func New(logger *log.Logger, model DisplayModel) (Display, error) {
|
|||||||
return newSsd1306(logger)
|
return newSsd1306(logger)
|
||||||
case MT12864A:
|
case MT12864A:
|
||||||
return newMt12864a(logger)
|
return newMt12864a(logger)
|
||||||
|
case MT12232A:
|
||||||
|
return newMt12232a(logger)
|
||||||
}
|
}
|
||||||
return nil, fmt.Errorf("invalid display model")
|
return nil, fmt.Errorf("invalid display model")
|
||||||
}
|
}
|
||||||
|
161
display/mt-12232a.go
Normal file
161
display/mt-12232a.go
Normal file
@ -0,0 +1,161 @@
|
|||||||
|
package display
|
||||||
|
|
||||||
|
import (
|
||||||
|
"fmt"
|
||||||
|
"image"
|
||||||
|
"log"
|
||||||
|
"math/rand"
|
||||||
|
"time"
|
||||||
|
|
||||||
|
"gitea.unprism.ru/yotia/display-test/pkg/mt12232a"
|
||||||
|
"github.com/stianeikeland/go-rpio/v4"
|
||||||
|
)
|
||||||
|
|
||||||
|
type displayMt12232a struct {
|
||||||
|
logger *log.Logger
|
||||||
|
|
||||||
|
// GPIO pins
|
||||||
|
dev mt12232a.Device
|
||||||
|
}
|
||||||
|
|
||||||
|
func newMt12232a(logger *log.Logger) (Display, error) {
|
||||||
|
dev, err := mt12232a.New(log.New(logger.Writer(), "display-mt12864 : ", log.LstdFlags))
|
||||||
|
if err != nil {
|
||||||
|
return nil, fmt.Errorf("mt12864 create: %w", err)
|
||||||
|
}
|
||||||
|
// Allocate bits
|
||||||
|
bits := make([][]byte, 32)
|
||||||
|
for i := 0; i < 32; i++ {
|
||||||
|
bits[i] = make([]byte, 122)
|
||||||
|
}
|
||||||
|
|
||||||
|
// if err := dev.PowerOn(); err != nil {
|
||||||
|
// return nil, fmt.Errorf("power on: %w", err)
|
||||||
|
// }
|
||||||
|
|
||||||
|
d := displayMt12232a{
|
||||||
|
logger: logger,
|
||||||
|
dev: dev,
|
||||||
|
}
|
||||||
|
|
||||||
|
// 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")
|
||||||
|
|
||||||
|
return &d, nil
|
||||||
|
}
|
||||||
|
|
||||||
|
func (d *displayMt12232a) test() {
|
||||||
|
d.logger.Println("Write")
|
||||||
|
d.dev.WriteCodeL(0xB8)
|
||||||
|
d.dev.WriteCodeL(0x13)
|
||||||
|
d.dev.WriteDataL(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())
|
||||||
|
|
||||||
|
//color := []byte{1, 0, 1, 0, 1, 0, 1, 0}
|
||||||
|
//color := []byte{1, 0, 1, 0, 1, 0, 0, 0}
|
||||||
|
|
||||||
|
//color := []byte{0, 0, 0, 0, 0, 0, 0, 0}
|
||||||
|
//color := byte(3)
|
||||||
|
start := time.Now()
|
||||||
|
//d.dev.WriteCodeL(0xB8)
|
||||||
|
//d.dev.WriteCodeL(0x13)
|
||||||
|
//d.dev.WriteDatasL([]byte{0, 0, 0, 0, 0, 0, 0, 0})
|
||||||
|
//d.dev.WriteDatasL([]byte{1, 0, 0, 0, 0, 0, 0, 0})
|
||||||
|
//d.dev.WriteDatasL([]byte{1, 1, 0, 0, 0, 0, 0, 0})
|
||||||
|
//d.dev.WriteDatasL([]byte{1, 1, 1, 0, 0, 0, 0, 0})
|
||||||
|
//d.dev.WriteDatasL([]byte{1, 1, 1, 1, 0, 0, 0, 0})
|
||||||
|
//d.dev.WriteDatasL([]byte{1, 1, 1, 1, 1, 0, 0, 0})
|
||||||
|
//d.dev.WriteDatasL([]byte{1, 1, 1, 1, 1, 1, 0, 0})
|
||||||
|
//d.dev.WriteDatasL([]byte{1, 1, 1, 1, 1, 1, 1, 0})
|
||||||
|
//d.dev.WriteDatasL([]byte{1, 1, 1, 1, 1, 1, 1, 1})
|
||||||
|
//
|
||||||
|
//d.dev.WriteDatasL([]byte{1, 0, 0, 0, 0, 0, 0, 0})
|
||||||
|
//d.dev.WriteDatasL([]byte{1, 0, 1, 0, 0, 0, 0, 0})
|
||||||
|
//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.dev.WriteCodeL(0xB8 | 1)
|
||||||
|
//d.dev.WriteCodeL(0x13)
|
||||||
|
//d.dev.WriteDatasL([]byte{1, 0, 0, 0, 0, 0, 0, 0})
|
||||||
|
//d.dev.WriteDatasL([]byte{1, 0, 1, 0, 0, 0, 0, 0})
|
||||||
|
//d.dev.WriteDatasL([]byte{1, 0, 1, 0, 1, 0, 0, 0})
|
||||||
|
//d.dev.WriteDatasL([]byte{1, 0, 1, 0, 1, 0, 1, 0})
|
||||||
|
|
||||||
|
for p := byte(0); p < 4; p++ {
|
||||||
|
d.dev.WriteCodeL(p | 0xB8)
|
||||||
|
d.dev.WriteCodeL(0x13)
|
||||||
|
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)})
|
||||||
|
}
|
||||||
|
}
|
||||||
|
end := time.Now()
|
||||||
|
d.logger.Println(end.Sub(start))
|
||||||
|
// 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])
|
||||||
|
// }
|
||||||
|
// }
|
||||||
|
//d.dev.WriteCodeL(0xAF) // Display on
|
||||||
|
//d.dev.WriteCodeR(0xAF) // Display on
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
func (d *displayMt12232a) GetBounds() image.Rectangle {
|
||||||
|
return image.Rect(0, 0, 122, 32)
|
||||||
|
}
|
||||||
|
|
||||||
|
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)
|
||||||
|
for c := 0; c < 61; c++ {
|
||||||
|
d.dev.WriteDatasL([]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],
|
||||||
|
img.Pix[int(p<<3+4)*122+c],
|
||||||
|
img.Pix[int(p<<3+3)*122+c],
|
||||||
|
img.Pix[int(p<<3+2)*122+c],
|
||||||
|
img.Pix[int(p<<3+1)*122+c],
|
||||||
|
img.Pix[int(p<<3+0)*122+c],
|
||||||
|
})
|
||||||
|
}
|
||||||
|
d.dev.WriteCodeR((3 - p) | 0xB8)
|
||||||
|
d.dev.WriteCodeR(0x00)
|
||||||
|
for c := 61; c < 122; c++ {
|
||||||
|
d.dev.WriteDatasR([]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],
|
||||||
|
img.Pix[int(p<<3+4)*122+c],
|
||||||
|
img.Pix[int(p<<3+3)*122+c],
|
||||||
|
img.Pix[int(p<<3+2)*122+c],
|
||||||
|
img.Pix[int(p<<3+1)*122+c],
|
||||||
|
img.Pix[int(p<<3+0)*122+c],
|
||||||
|
})
|
||||||
|
}
|
||||||
|
}
|
||||||
|
return nil
|
||||||
|
}
|
||||||
|
|
||||||
|
func (d *displayMt12232a) Close() error {
|
||||||
|
return rpio.Close()
|
||||||
|
}
|
130
main.go
130
main.go
@ -84,94 +84,92 @@ func DrawProgress(ctx context.Context, timeout time.Duration) error {
|
|||||||
func Init(ctx context.Context) error {
|
func Init(ctx context.Context) error {
|
||||||
// Display init
|
// Display init
|
||||||
var err error
|
var err error
|
||||||
dev, err = display.New(log.New(log.Writer(), "display", log.LstdFlags), display.SSD1306)
|
dev, err = display.New(log.New(log.Writer(), "display", log.LstdFlags), display.MT12232A)
|
||||||
if err != nil {
|
if err != nil {
|
||||||
return fmt.Errorf("new display: %w", err)
|
return fmt.Errorf("new display: %w", err)
|
||||||
}
|
}
|
||||||
logger.Println("Display inited")
|
logger.Println("Display inited")
|
||||||
|
|
||||||
|
// Create drawer
|
||||||
d := drawer.New(dev)
|
d := drawer.New(dev)
|
||||||
|
|
||||||
d.Clear()
|
d.Clear()
|
||||||
d.PutText(0, d.GetFont().Metrics().Height.Ceil(), "Initing modem...")
|
//d.FillBar(0, 0, 10, 10, 1)
|
||||||
|
d.PutText(0, 10, "CGSG")
|
||||||
|
d.PutText(0, 24, "forever!!!")
|
||||||
d.Flush()
|
d.Flush()
|
||||||
|
|
||||||
// Modem init
|
// Modem init
|
||||||
mInitCtx, mInitCtxCancel := context.WithCancel(ctx)
|
//mInitCtx, mInitCtxCancel := context.WithCancel(ctx)
|
||||||
go DrawProgress(mInitCtx, 13*time.Second)
|
//go DrawProgress(mInitCtx, 13*time.Second)
|
||||||
defer mInitCtxCancel()
|
//defer mInitCtxCancel()
|
||||||
|
//
|
||||||
m = modem.New(log.New(logger.Writer(), "modem : ", log.LstdFlags))
|
//m = modem.New(log.New(logger.Writer(), "modem : ", log.LstdFlags))
|
||||||
if err := m.Init(); err != nil {
|
//if err := m.Init(); err != nil {
|
||||||
return fmt.Errorf("modem init: %w", err)
|
// return fmt.Errorf("modem init: %w", err)
|
||||||
}
|
//}
|
||||||
logger.Println("Display inited")
|
//logger.Println("Display inited")
|
||||||
mInitCtxCancel()
|
//mInitCtxCancel()
|
||||||
|
//
|
||||||
d.Clear()
|
//d.Clear()
|
||||||
d.PutText(0, d.GetFont().Metrics().Height.Ceil(), "Modem inited.")
|
//d.PutText(0, d.GetFont().Metrics().Height.Ceil(), "Modem inited.")
|
||||||
d.PutText(0, d.GetFont().Metrics().Height.Ceil()*2, "Starting test...")
|
//d.PutText(0, d.GetFont().Metrics().Height.Ceil()*2, "Starting test...")
|
||||||
d.Flush()
|
//d.Flush()
|
||||||
return nil
|
return nil
|
||||||
}
|
}
|
||||||
func Close() {
|
func Close() {
|
||||||
m.Close()
|
//m.Close()
|
||||||
if d != nil {
|
//if d != nil {
|
||||||
d.Clear()
|
// d.Clear()
|
||||||
d.Flush()
|
// d.Flush()
|
||||||
}
|
//}
|
||||||
dev.Close()
|
dev.Close()
|
||||||
}
|
}
|
||||||
|
|
||||||
func MainLoop(ctx context.Context) error {
|
//func MainLoop(ctx context.Context) error {
|
||||||
mainLoopTimeout := time.Second
|
// mainLoopTimeout := time.Second
|
||||||
|
//
|
||||||
frameCounter := 0
|
// frameCounter := 0
|
||||||
deadline := time.Now().Add(100 * time.Millisecond)
|
// deadline := time.Now().Add(100 * time.Millisecond)
|
||||||
for {
|
// for {
|
||||||
select {
|
// select {
|
||||||
case <-ctx.Done():
|
// case <-ctx.Done():
|
||||||
return nil
|
// return nil
|
||||||
case <-time.After(time.Until(deadline)):
|
// case <-time.After(time.Until(deadline)):
|
||||||
deadline = time.Now().Add(mainLoopTimeout)
|
// deadline = time.Now().Add(mainLoopTimeout)
|
||||||
|
//
|
||||||
st, _ := m.Gps().GetStatus()
|
// st, _ := m.Gps().GetStatus()
|
||||||
data := m.GetData()
|
// data := m.GetData()
|
||||||
|
//
|
||||||
coordsStr := fmt.Sprintf("%03d°%02.0f'%s %03d°%02.0f'%s",
|
// coordsStr := fmt.Sprintf("%03d°%02.0f'%s %03d°%02.0f'%s",
|
||||||
int(data.Latitude), (data.Latitude-float64(int(data.Latitude)))*100, data.LatitudeIndicator,
|
// int(data.Latitude), (data.Latitude-float64(int(data.Latitude)))*100, data.LatitudeIndicator,
|
||||||
int(data.Longitude), (data.Longitude-float64(int(data.Longitude)))*100, data.LongitudeIndicator)
|
// int(data.Longitude), (data.Longitude-float64(int(data.Longitude)))*100, data.LongitudeIndicator)
|
||||||
var str1 string
|
// var str1 string
|
||||||
var str2 string
|
// var str2 string
|
||||||
|
//
|
||||||
if frameCounter%4 < 2 {
|
// if frameCounter%4 < 2 {
|
||||||
str2 = fmt.Sprintf("Sat. count: %d", st.FoundSatelitesCount)
|
// str2 = fmt.Sprintf("Sat. count: %d", st.FoundSatelitesCount)
|
||||||
} else {
|
// } else {
|
||||||
str2 = coordsStr
|
// str2 = coordsStr
|
||||||
}
|
// }
|
||||||
str1 = fmt.Sprintf("%s", time.Now().Format("15:04:05"))
|
// str1 = fmt.Sprintf("%s", time.Now().Format("15:04:05"))
|
||||||
|
//
|
||||||
d.Clear()
|
// d.Clear()
|
||||||
d.PutText(0, d.GetFont().Metrics().Height.Ceil(), str1)
|
// d.PutText(0, d.GetFont().Metrics().Height.Ceil(), str1)
|
||||||
d.PutText(0, d.GetFont().Metrics().Height.Ceil()*2, str2)
|
// d.PutText(0, d.GetFont().Metrics().Height.Ceil()*2, str2)
|
||||||
d.Flush()
|
// d.Flush()
|
||||||
frameCounter++
|
// frameCounter++
|
||||||
}
|
// }
|
||||||
}
|
// }
|
||||||
}
|
//}
|
||||||
|
|
||||||
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, err := display.New(logger, display.MT12864A)
|
if err := Init(ctx); err != nil {
|
||||||
if err != nil {
|
|
||||||
return err
|
return err
|
||||||
}
|
}
|
||||||
time.Sleep(2 * time.Second)
|
defer Close()
|
||||||
defer disp.Close()
|
|
||||||
// if err := Init(ctx); err != nil {
|
|
||||||
// return err
|
|
||||||
// }
|
|
||||||
// defer Close()
|
|
||||||
// if err := MainLoop(ctx); err != nil {
|
// if err := MainLoop(ctx); err != nil {
|
||||||
// return err
|
// return err
|
||||||
// }
|
// }
|
||||||
|
@ -21,12 +21,13 @@ type mt12232a struct {
|
|||||||
|
|
||||||
type Device interface {
|
type Device interface {
|
||||||
PowerOn() error
|
PowerOn() error
|
||||||
SetPixel(x, y byte, c bool) error
|
|
||||||
|
|
||||||
WriteCodeL(c byte) error
|
WriteCodeL(c byte) error
|
||||||
WriteCodeR(c byte) error
|
WriteCodeR(c byte) error
|
||||||
WriteDataL(b byte) error
|
WriteDataL(b byte) error
|
||||||
WriteDataR(b byte) error
|
WriteDataR(b byte) error
|
||||||
|
WriteDatasL(b []byte) error
|
||||||
|
WriteDatasR(b []byte) error
|
||||||
|
|
||||||
ReadDataL() (byte, error)
|
ReadDataL() (byte, error)
|
||||||
ReadDataR() (byte, error)
|
ReadDataR() (byte, error)
|
||||||
@ -42,23 +43,22 @@ func New(logger *log.Logger) (Device, error) {
|
|||||||
logger: logger,
|
logger: logger,
|
||||||
|
|
||||||
dev: parallel8bit.New(logger, parallel8bit.DevicePins{
|
dev: parallel8bit.New(logger, parallel8bit.DevicePins{
|
||||||
PinA0: rpio.Pin(18),
|
PinA0: rpio.Pin(19),
|
||||||
PinRW: rpio.Pin(17),
|
PinRW: rpio.Pin(13),
|
||||||
PinE: rpio.Pin(27),
|
PinE: rpio.Pin(12),
|
||||||
|
|
||||||
PinDB0: rpio.Pin(22),
|
PinDB0: rpio.Pin(22),
|
||||||
PinDB1: rpio.Pin(10),
|
PinDB1: rpio.Pin(10),
|
||||||
PinDB2: rpio.Pin(9), // From 21
|
PinDB2: rpio.Pin(9),
|
||||||
PinDB3: rpio.Pin(11),
|
PinDB3: rpio.Pin(11),
|
||||||
PinDB4: rpio.Pin(12),
|
PinDB4: rpio.Pin(21),
|
||||||
PinDB5: rpio.Pin(16), // From 32
|
PinDB5: rpio.Pin(20),
|
||||||
PinDB6: rpio.Pin(20), // From 31
|
PinDB6: rpio.Pin(26),
|
||||||
PinDB7: rpio.Pin(13), // From 33
|
PinDB7: rpio.Pin(16),
|
||||||
|
|
||||||
}),
|
}),
|
||||||
|
|
||||||
pinCS: rpio.Pin(19),
|
pinCS: rpio.Pin(17),
|
||||||
pinRES: rpio.Pin(21),
|
pinRES: rpio.Pin(27),
|
||||||
}
|
}
|
||||||
d.pinCS.Output()
|
d.pinCS.Output()
|
||||||
d.pinRES.Output()
|
d.pinRES.Output()
|
||||||
@ -71,47 +71,37 @@ func (d *mt12232a) Close() error {
|
|||||||
return rpio.Close()
|
return rpio.Close()
|
||||||
}
|
}
|
||||||
|
|
||||||
func (d *mt12232a) SetPixel(x, y byte, c bool) error {
|
func (d *mt12232a) status() {
|
||||||
// var c8 byte
|
d.logger.Println("STATUS:", d.ReadStatus(0)&0xF0, d.ReadStatus(1)&0xF0)
|
||||||
// var mask byte
|
|
||||||
|
|
||||||
// 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
|
|
||||||
}
|
|
||||||
return nil
|
|
||||||
}
|
}
|
||||||
|
|
||||||
func (d *mt12232a) PowerOn() error {
|
func (d *mt12232a) PowerOn() error {
|
||||||
|
d.status()
|
||||||
d.logger.Println(d.ReadStatus(0)) // Should be 0
|
d.logger.Println(d.ReadStatus(0)) // Should be 0
|
||||||
d.logger.Println("Reset")
|
d.logger.Println("Reset")
|
||||||
|
d.status()
|
||||||
d.pinRES.Low()
|
d.pinRES.Low()
|
||||||
time.Sleep(time.Microsecond)
|
time.Sleep(time.Microsecond)
|
||||||
d.logger.Println(d.ReadStatus(0)) // Should be 48 (power off and reset)
|
d.logger.Println(d.ReadStatus(0)) // Should be 48 (power off and reset)
|
||||||
d.pinRES.High()
|
d.pinRES.High()
|
||||||
time.Sleep(10 * time.Microsecond)
|
time.Sleep(4 * time.Millisecond)
|
||||||
d.logger.Println(d.ReadStatus(0)) // Should be 32 (power off)
|
d.logger.Println(d.ReadStatus(0)) // Should be 32 (power off)
|
||||||
|
|
||||||
// Module is reset and should be turned off
|
// Module is reset and should be turned off
|
||||||
if d.ReadStatus(0) == 0 || d.ReadStatus(1) == 0 {
|
if d.ReadStatus(0) == 0 || d.ReadStatus(1) == 0 {
|
||||||
return fmt.Errorf("no response from display(or it is possible that it is turned on but...)")
|
return fmt.Errorf("no response from display(or it is possible that it is turned on but...)")
|
||||||
}
|
}
|
||||||
|
for i := 0; i < 100; i++ {
|
||||||
|
if ((d.ReadStatus(0) >> 4) & 1) == 0 {
|
||||||
|
break
|
||||||
|
}
|
||||||
|
}
|
||||||
|
d.status()
|
||||||
|
d.status()
|
||||||
|
d.status()
|
||||||
|
|
||||||
d.logger.Println("Power on")
|
d.logger.Println("Power on")
|
||||||
|
d.status()
|
||||||
d.WriteCodeL(0xE2) // Reset
|
d.WriteCodeL(0xE2) // Reset
|
||||||
d.WriteCodeR(0xE2) // Reset
|
d.WriteCodeR(0xE2) // Reset
|
||||||
d.WriteCodeL(0xEE) // ReadModifyWrite off
|
d.WriteCodeL(0xEE) // ReadModifyWrite off
|
||||||
@ -125,15 +115,45 @@ func (d *mt12232a) PowerOn() error {
|
|||||||
d.WriteCodeL(0xA1) // Invert scan RAM
|
d.WriteCodeL(0xA1) // Invert scan RAM
|
||||||
d.WriteCodeR(0xA0) // NonInvert scan RAM
|
d.WriteCodeR(0xA0) // NonInvert scan RAM
|
||||||
|
|
||||||
|
d.status()
|
||||||
d.logger.Println("Display on")
|
d.logger.Println("Display on")
|
||||||
d.WriteCodeL(0xAF) // Display on
|
d.WriteCodeL(0xAF) // Display on
|
||||||
d.WriteCodeR(0xAF) // Display on
|
d.WriteCodeR(0xAF) // Display on
|
||||||
|
|
||||||
|
d.status()
|
||||||
|
time.Sleep(100 * time.Millisecond)
|
||||||
|
d.status()
|
||||||
|
time.Sleep(100 * time.Millisecond)
|
||||||
|
d.status()
|
||||||
|
time.Sleep(100 * time.Millisecond)
|
||||||
|
d.status()
|
||||||
|
time.Sleep(100 * time.Millisecond)
|
||||||
|
d.status()
|
||||||
|
time.Sleep(100 * time.Millisecond)
|
||||||
|
d.status()
|
||||||
|
time.Sleep(100 * time.Millisecond)
|
||||||
|
d.status()
|
||||||
|
time.Sleep(100 * time.Millisecond)
|
||||||
|
d.status()
|
||||||
|
time.Sleep(100 * time.Millisecond)
|
||||||
|
d.status()
|
||||||
|
time.Sleep(100 * time.Millisecond)
|
||||||
|
d.status()
|
||||||
|
time.Sleep(100 * time.Millisecond)
|
||||||
|
|
||||||
// Check that crystals are turned on
|
// Check that crystals are turned on
|
||||||
if (d.ReadStatus(0) & (1 << 5)) != 0 {
|
if ((d.ReadStatus(0) >> 5) & 1) == 1 {
|
||||||
|
d.logger.Println("Left cristal is still off")
|
||||||
|
}
|
||||||
|
if ((d.ReadStatus(0) >> 5) & 1) == 1 {
|
||||||
|
d.logger.Println("Right cristal is still off")
|
||||||
|
}
|
||||||
|
|
||||||
|
// The same but with error
|
||||||
|
if ((d.ReadStatus(0) >> 5) & 1) == 1 {
|
||||||
return fmt.Errorf("Left cristal is still off")
|
return fmt.Errorf("Left cristal is still off")
|
||||||
}
|
}
|
||||||
if (d.ReadStatus(1) & (1 << 5)) != 0 {
|
if ((d.ReadStatus(0) >> 5) & 1) == 1 {
|
||||||
return fmt.Errorf("Right cristal is still off")
|
return fmt.Errorf("Right cristal is still off")
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -160,6 +180,14 @@ func (d *mt12232a) WriteDataR(b byte) error {
|
|||||||
return d.writeByte(b, 1, 1)
|
return d.writeByte(b, 1, 1)
|
||||||
}
|
}
|
||||||
|
|
||||||
|
func (d *mt12232a) WriteDatasL(b []byte) error {
|
||||||
|
return d.writeBytes(b, 1, 0)
|
||||||
|
}
|
||||||
|
|
||||||
|
func (d *mt12232a) WriteDatasR(b []byte) error {
|
||||||
|
return d.writeBytes(b, 1, 1)
|
||||||
|
}
|
||||||
|
|
||||||
// Read data
|
// Read data
|
||||||
|
|
||||||
func (d *mt12232a) ReadDataL() (byte, error) {
|
func (d *mt12232a) ReadDataL() (byte, error) {
|
||||||
@ -173,7 +201,6 @@ func (d *mt12232a) ReadDataR() (byte, error) {
|
|||||||
// Low level functions
|
// Low level functions
|
||||||
|
|
||||||
func (d *mt12232a) writeByte(b byte, cd, cs rpio.State) error {
|
func (d *mt12232a) writeByte(b byte, cd, cs rpio.State) error {
|
||||||
// d.logger.Println("Write byte", b, cd, l, r)
|
|
||||||
if err := d.waitReady(cs); err != nil {
|
if err := d.waitReady(cs); err != nil {
|
||||||
return fmt.Errorf("wait ready: %w", err)
|
return fmt.Errorf("wait ready: %w", err)
|
||||||
}
|
}
|
||||||
@ -183,6 +210,16 @@ func (d *mt12232a) writeByte(b byte, cd, cs rpio.State) error {
|
|||||||
return nil
|
return nil
|
||||||
}
|
}
|
||||||
|
|
||||||
|
func (d *mt12232a) writeBytes(b []byte, cd, cs rpio.State) error {
|
||||||
|
if err := d.waitReady(cs); err != nil {
|
||||||
|
return fmt.Errorf("wait ready: %w", err)
|
||||||
|
}
|
||||||
|
d.pinCS.Write(cs) // Select cristals
|
||||||
|
|
||||||
|
d.dev.WriteBytes(b, cd)
|
||||||
|
return nil
|
||||||
|
}
|
||||||
|
|
||||||
func (d *mt12232a) readByte(cd, cs rpio.State) (byte, error) {
|
func (d *mt12232a) readByte(cd, cs rpio.State) (byte, error) {
|
||||||
// Setup
|
// Setup
|
||||||
if err := d.waitReady(cs); err != nil {
|
if err := d.waitReady(cs); err != nil {
|
||||||
|
@ -18,8 +18,11 @@ const (
|
|||||||
type Device interface {
|
type Device interface {
|
||||||
Reset()
|
Reset()
|
||||||
WriteByte(b byte, cd rpio.State)
|
WriteByte(b byte, cd rpio.State)
|
||||||
|
WriteBytes(b []byte, cd rpio.State)
|
||||||
ReadByte(cd rpio.State) byte
|
ReadByte(cd rpio.State) byte
|
||||||
|
|
||||||
|
Pins() DevicePins
|
||||||
|
|
||||||
WaitReady() error
|
WaitReady() error
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -44,6 +47,7 @@ type DevicePins struct {
|
|||||||
type device struct {
|
type device struct {
|
||||||
logger *log.Logger
|
logger *log.Logger
|
||||||
|
|
||||||
|
isBusOutput bool
|
||||||
DevicePins
|
DevicePins
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -54,6 +58,10 @@ func New(logger *log.Logger, pins DevicePins) Device {
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
func (d *device) Pins() DevicePins {
|
||||||
|
return d.DevicePins
|
||||||
|
}
|
||||||
|
|
||||||
func (d *device) Reset() {
|
func (d *device) Reset() {
|
||||||
d.PinA0.Output()
|
d.PinA0.Output()
|
||||||
d.PinRW.Output()
|
d.PinRW.Output()
|
||||||
@ -88,6 +96,31 @@ func (d *device) WriteByte(b byte, cd rpio.State) {
|
|||||||
time.Sleep(time.Millisecond - dataStrobeTimeout - adressWriteTimeout)
|
time.Sleep(time.Millisecond - dataStrobeTimeout - adressWriteTimeout)
|
||||||
}
|
}
|
||||||
|
|
||||||
|
func (d *device) WriteBytes(b []byte, cd rpio.State) {
|
||||||
|
// d.logger.Println("Write byte", b, cd, l, r)
|
||||||
|
d.busOutput()
|
||||||
|
d.PinRW.Low() // We write
|
||||||
|
d.PinA0.Write(cd)
|
||||||
|
|
||||||
|
// 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()
|
||||||
|
time.Sleep(time.Millisecond - dataStrobeTimeout - adressWriteTimeout)
|
||||||
|
}
|
||||||
|
|
||||||
func (d *device) ReadByte(cd rpio.State) byte {
|
func (d *device) ReadByte(cd rpio.State) byte {
|
||||||
// Setup
|
// Setup
|
||||||
var b byte
|
var b byte
|
||||||
@ -148,6 +181,9 @@ func (d *device) WaitReady() error {
|
|||||||
|
|
||||||
// Set bus pins to output
|
// Set bus pins to output
|
||||||
func (d *device) busOutput() {
|
func (d *device) busOutput() {
|
||||||
|
// if d.isBusOutput {
|
||||||
|
// return
|
||||||
|
// }
|
||||||
d.PinDB0.Output()
|
d.PinDB0.Output()
|
||||||
d.PinDB1.Output()
|
d.PinDB1.Output()
|
||||||
d.PinDB2.Output()
|
d.PinDB2.Output()
|
||||||
@ -156,9 +192,13 @@ func (d *device) busOutput() {
|
|||||||
d.PinDB5.Output()
|
d.PinDB5.Output()
|
||||||
d.PinDB6.Output()
|
d.PinDB6.Output()
|
||||||
d.PinDB7.Output()
|
d.PinDB7.Output()
|
||||||
|
d.isBusOutput = true
|
||||||
}
|
}
|
||||||
|
|
||||||
func (d *device) busInput() {
|
func (d *device) busInput() {
|
||||||
|
//if !d.isBusOutput {
|
||||||
|
// return
|
||||||
|
//}
|
||||||
d.PinDB0.Input()
|
d.PinDB0.Input()
|
||||||
d.PinDB1.Input()
|
d.PinDB1.Input()
|
||||||
d.PinDB2.Input()
|
d.PinDB2.Input()
|
||||||
@ -167,4 +207,5 @@ func (d *device) busInput() {
|
|||||||
d.PinDB5.Input()
|
d.PinDB5.Input()
|
||||||
d.PinDB6.Input()
|
d.PinDB6.Input()
|
||||||
d.PinDB7.Input()
|
d.PinDB7.Input()
|
||||||
|
d.isBusOutput = false
|
||||||
}
|
}
|
||||||
|
Loading…
Reference in New Issue
Block a user