forked from jetkvm/kvm
-
Notifications
You must be signed in to change notification settings - Fork 9
Expand file tree
/
Copy pathio.go
More file actions
172 lines (155 loc) · 4.59 KB
/
io.go
File metadata and controls
172 lines (155 loc) · 4.59 KB
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
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
package kvm
import (
"fmt"
"os"
"strconv"
"strings"
"time"
)
const (
gpioBasePath = "/sys/class/gpio"
ledGreenPath = "/sys/class/leds/led:g"
ledYellowPath = "/sys/class/leds/led:y"
)
func exportGPIO(pin int) error {
exportFile := gpioBasePath + "/export"
return os.WriteFile(exportFile, []byte(strconv.Itoa(pin)), 0644)
}
func unexportGPIO(pin int) error {
unexportFile := gpioBasePath + "/unexport"
return os.WriteFile(unexportFile, []byte(strconv.Itoa(pin)), 0644)
}
func isGPIOExported(pin int) bool {
gpioPath := fmt.Sprintf("%s/gpio%d", gpioBasePath, pin)
_, err := os.Stat(gpioPath)
return err == nil
}
func setGPIODirection(pin int, direction string) error {
if !isGPIOExported(pin) {
if err := exportGPIO(pin); err != nil {
return fmt.Errorf("failed to export GPIO: %v", err)
}
}
directionFile := fmt.Sprintf("%s/gpio%d/direction", gpioBasePath, pin)
return os.WriteFile(directionFile, []byte(direction), 0644)
}
func setGPIOValue(pin int, status bool) error {
var value int
if status {
value = 1
} else {
value = 0
}
if !isGPIOExported(pin) {
if err := exportGPIO(pin); err != nil {
return fmt.Errorf("failed to export GPIO: %v", err)
}
if err := setGPIODirection(pin, "out"); err != nil {
return fmt.Errorf("failed to set GPIO direction: %v", err)
}
}
valueFile := fmt.Sprintf("%s/gpio%d/value", gpioBasePath, pin)
return os.WriteFile(valueFile, []byte(strconv.Itoa(value)), 0644)
}
func setLedMode(ledConfigPath string, mode string) error {
switch mode {
case "network-link":
err := os.WriteFile(ledConfigPath+"/trigger", []byte("netdev"), 0644)
if err != nil {
return fmt.Errorf("failed to set LED trigger: %v", err)
}
err = os.WriteFile(ledConfigPath+"/device_name", []byte("eth0"), 0644)
if err != nil {
return fmt.Errorf("failed to set LED device name: %v", err)
}
err = os.WriteFile(ledConfigPath+"/link", []byte("1"), 0644)
if err != nil {
return fmt.Errorf("failed to set LED link: %v", err)
}
case "network-tx":
err := os.WriteFile(ledConfigPath+"/trigger", []byte("netdev"), 0644)
if err != nil {
return fmt.Errorf("failed to set LED trigger: %v", err)
}
err = os.WriteFile(ledConfigPath+"/device_name", []byte("eth0"), 0644)
if err != nil {
return fmt.Errorf("failed to set LED device name: %v", err)
}
err = os.WriteFile(ledConfigPath+"/tx", []byte("1"), 0644)
if err != nil {
return fmt.Errorf("failed to set LED tx: %v", err)
}
case "network-rx":
err := os.WriteFile(ledConfigPath+"/trigger", []byte("netdev"), 0644)
if err != nil {
return fmt.Errorf("failed to set LED trigger: %v", err)
}
err = os.WriteFile(ledConfigPath+"/device_name", []byte("eth0"), 0644)
if err != nil {
return fmt.Errorf("failed to set LED device name: %v", err)
}
err = os.WriteFile(ledConfigPath+"/rx", []byte("1"), 0644)
if err != nil {
return fmt.Errorf("failed to set LED rx: %v", err)
}
case "kernel-activity":
err := os.WriteFile(ledConfigPath+"/trigger", []byte("activity"), 0644)
if err != nil {
return fmt.Errorf("failed to set LED trigger: %v", err)
}
default:
return fmt.Errorf("invalid LED mode: %s", mode)
}
return nil
}
func pulseGPIO(pin int, duration time.Duration) error {
// First pull up
if err := setGPIOValue(pin, true); err != nil {
return err
}
// Wait for duration
time.Sleep(duration)
// Then pull down
if err := setGPIOValue(pin, false); err != nil {
return err
}
return nil
}
func getGPIOValue(pin int) (bool, error) {
if !isGPIOExported(pin) {
if err := exportGPIO(pin); err != nil {
return false, fmt.Errorf("failed to export GPIO: %v", err)
}
if err := setGPIODirection(pin, "in"); err != nil {
return false, fmt.Errorf("failed to set GPIO direction: %v", err)
}
}
valueFile := fmt.Sprintf("%s/gpio%d/value", gpioBasePath, pin)
data, err := os.ReadFile(valueFile)
if err != nil {
return false, fmt.Errorf("failed to read GPIO value: %v", err)
}
value := strings.TrimSpace(string(data))
return value == "1", nil
}
func resetIOInput() error {
// Reset IO2 (GPIO0) and IO3 (GPIO1) to input mode
if err := setGPIODirection(0, "in"); err != nil {
return fmt.Errorf("failed to reset IO2: %v", err)
}
if err := setGPIODirection(1, "in"); err != nil {
return fmt.Errorf("failed to reset IO3: %v", err)
}
return nil
}
func initGPIO() {
LoadConfig()
// IO0: GPIO58 IO1: GPIO59
_ = setGPIOValue(58, config.IO0Status)
_ = setGPIOValue(59, config.IO1Status)
// IO2: GPIO0 IO3: GPIO1 - Input
_ = setGPIODirection(0, "in")
_ = setGPIODirection(1, "in")
_ = setLedMode(ledYellowPath, config.LEDYellowMode)
_ = setLedMode(ledGreenPath, config.LEDGreenMode)
}