picossci-ffb-wheel/main.go at main · SWITCHSCIENCE/picossci-ffb-wheel · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
package main

// MARK: import

import (
	"context"
	"machine"
	"machine/usb"
	"time"

	"github.com/SWITCHSCIENCE/ffb_steering_controller/control"
	"github.com/SWITCHSCIENCE/ffb_steering_controller/settings"

	"github.com/SWITCHSCIENCE/picossci-ffb-wheel/board"
)

const (
	FLASH_TARGET_OFFSET = 0 // 書き込み開始アドレス(例)
)

// Flashに1ページ書き込み
func writeFlashBlock(data []byte) error {
	err := machine.Flash.EraseBlocks(0, 1)
	if err != nil {
		return err
	}
	if _, err := machine.Flash.WriteAt(data, FLASH_TARGET_OFFSET); err != nil {
		return err
	}
	return nil
}

// Flashから読み出し
func readFlashBlock() ([]byte, error) {
	buff := make([]byte, machine.Flash.WriteBlockSize())
	n, err := machine.Flash.ReadAt(buff, FLASH_TARGET_OFFSET)
	if err != nil {
		return nil, err
	}
	return buff[:n], nil
}

// MARK: variables
var (
	sw [3]bool
)

// MARK: functions

func init() {
	//usb.VendorID = 0x2341
	//usb.ProductID = 0x8036
	usb.Product = "DIY Steering Controller"
	usb.Manufacturer = "Switch Science"
	board.LCD.Show(board.Logo)
	board.LCD.Display()
	if false {
		for !machine.Serial.DTR() {
			time.Sleep(100 * time.Millisecond)
		}
		//println("boot")
		//println(machine.FlashDataStart())
	}
}

func update(menu *Menu) {
	now := [3]bool{
		!board.SW1.Get(),
		!board.SW2.Get(),
		!board.SW3.Get(),
	}
	active := [3]bool{
		now[0] && !sw[0],
		now[1] && !sw[1],
		now[2] && !sw[2],
	}
	copy(sw[:], now[:])
	if active[0] {
		menu.Up()
	} else if active[1] {
		menu.Enter()
	} else if active[2] {
		menu.Down()
	}
	if menu.IsSetting() {
		board.LED1.Low()
	} else {
		board.LED1.Low()
	}
}

func main() {
	board.LED2.Low()
	can, err := board.NewCan()
	if err != nil {
		println(err)
		return
	}
	js := control.NewWheel(can)
	b, err := readFlashBlock()
	if err != nil {
		println(err)
		return
	}
	s, err := settings.Unmarshal(b)
	if err != nil {
		println(err)
		s = settings.Default()
	}
	if err := settings.Update(s); err != nil {
		println(err)
	}
	ctx, cancel := context.WithCancel(context.Background())
	go func() {
		menu := NewMenu()
		tick := time.NewTicker(20 * time.Millisecond)
		for {
			select {
			case <-ctx.Done():
				return
			case <-tick.C:
				update(menu)
			}
		}
	}()
	defer cancel()
	for {
		if err := js.Loop(ctx); err != nil {
			println(err)
			time.Sleep(3 * time.Second)
		}
	}
}