-
Notifications
You must be signed in to change notification settings - Fork 2
/
sensors.go
102 lines (86 loc) · 1.92 KB
/
sensors.go
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
package matrix
//#include "sensors.h"
import (
"C"
)
///////////////////////
// SENSOR BUS INITS //
/////////////////////
func imuInit() Imu {
C.imu_init()
return Imu{}
}
func uvInit() Uv {
C.uv_init()
return Uv{}
}
func humidityInit() Humidity {
C.humidity_init()
return Humidity{}
}
func pressureInit() Pressure {
C.pressure_init()
return Pressure{}
}
///////////////////////
// SENSOR STRUCTS //
/////////////////////
// Imu sensor values
type Imu struct {
AccelX, AccelY, AccelZ float32
GyroX, GyroY, GyroZ float32
Yaw, Pitch, Roll float32
MagX, MagY, MagZ float32
}
// Uv sensor values
type Uv struct {
Uv float32
}
// Humidity sensor values
type Humidity struct {
Humidity float32
Temperature float32
}
// Pressure sensor values
type Pressure struct {
Altitude float32
Pressure float32
Temperature float32
}
///////////////////////
// SENSOR UPDATES //
/////////////////////
// Update Imu{} values
func (s *Imu) Read() {
var values C.imu_values = C.imu_read()
s.AccelX = float32(values.accel_x)
s.AccelY = float32(values.accel_y)
s.AccelZ = float32(values.accel_z)
s.GyroX = float32(values.gyro_x)
s.GyroY = float32(values.gyro_y)
s.GyroZ = float32(values.gyro_z)
s.Yaw = float32(values.yaw)
s.Pitch = float32(values.pitch)
s.Roll = float32(values.roll)
s.MagX = float32(values.mag_x)
s.MagY = float32(values.mag_y)
s.MagZ = float32(values.mag_z)
}
// Update Uv{} values
func (s *Uv) Read() {
var values C.uv_values = C.uv_read()
s.Uv = float32(values.uv)
}
// Update Humidity{} values
func (s *Humidity) Read() {
var values C.humidity_values = C.humidity_read()
s.Humidity = float32(values.humidity)
s.Temperature = float32(values.temperature)
}
// Update Pressure{} values
func (s *Pressure) Read() {
var values C.pressure_values = C.pressure_read()
s.Altitude = float32(values.altitude)
s.Pressure = float32(values.pressure)
s.Temperature = float32(values.temperature)
}