2016-01-30 02:00:27 -08:00
|
|
|
package chip
|
|
|
|
|
|
|
|
import (
|
2022-12-05 18:28:57 +01:00
|
|
|
"fmt"
|
2023-12-05 20:26:28 +01:00
|
|
|
"strconv"
|
2017-04-06 09:53:52 +02:00
|
|
|
"strings"
|
2016-01-30 02:00:27 -08:00
|
|
|
"testing"
|
|
|
|
|
2023-10-20 10:27:09 +02:00
|
|
|
"github.com/stretchr/testify/assert"
|
2023-11-12 14:17:02 +01:00
|
|
|
"github.com/stretchr/testify/require"
|
2023-11-15 20:51:52 +01:00
|
|
|
|
2023-05-20 14:25:21 +02:00
|
|
|
"gobot.io/x/gobot/v2"
|
|
|
|
"gobot.io/x/gobot/v2/drivers/gpio"
|
|
|
|
"gobot.io/x/gobot/v2/drivers/i2c"
|
2023-12-05 20:26:28 +01:00
|
|
|
"gobot.io/x/gobot/v2/platforms/adaptors"
|
2023-05-20 14:25:21 +02:00
|
|
|
"gobot.io/x/gobot/v2/system"
|
2016-01-30 02:00:27 -08:00
|
|
|
)
|
|
|
|
|
2022-11-20 19:22:26 +01:00
|
|
|
// make sure that this Adaptor fulfills all the required interfaces
|
2023-10-20 20:50:42 +02:00
|
|
|
var (
|
|
|
|
_ gobot.Adaptor = (*Adaptor)(nil)
|
|
|
|
_ gobot.DigitalPinnerProvider = (*Adaptor)(nil)
|
|
|
|
_ gobot.PWMPinnerProvider = (*Adaptor)(nil)
|
|
|
|
_ gpio.DigitalReader = (*Adaptor)(nil)
|
|
|
|
_ gpio.DigitalWriter = (*Adaptor)(nil)
|
|
|
|
_ gpio.PwmWriter = (*Adaptor)(nil)
|
|
|
|
_ gpio.ServoWriter = (*Adaptor)(nil)
|
|
|
|
_ i2c.Connector = (*Adaptor)(nil)
|
|
|
|
)
|
2016-08-26 14:23:03 +02:00
|
|
|
|
2022-11-05 07:42:28 +01:00
|
|
|
var mockPaths = []string{
|
|
|
|
"/sys/class/gpio/export",
|
|
|
|
"/sys/class/gpio/unexport",
|
|
|
|
"/sys/class/gpio/gpio50/value",
|
|
|
|
"/sys/class/gpio/gpio50/direction",
|
|
|
|
"/sys/class/gpio/gpio139/value",
|
|
|
|
"/sys/class/gpio/gpio139/direction",
|
|
|
|
"/sys/class/pwm/pwmchip0/export",
|
|
|
|
"/sys/class/pwm/pwmchip0/unexport",
|
|
|
|
"/sys/class/pwm/pwmchip0/pwm0/enable",
|
|
|
|
"/sys/class/pwm/pwmchip0/pwm0/duty_cycle",
|
|
|
|
"/sys/class/pwm/pwmchip0/pwm0/polarity",
|
|
|
|
"/sys/class/pwm/pwmchip0/pwm0/period",
|
|
|
|
}
|
|
|
|
|
2022-11-20 19:22:26 +01:00
|
|
|
func initTestAdaptorWithMockedFilesystem() (*Adaptor, *system.MockFilesystem) {
|
2016-09-25 20:19:19 +02:00
|
|
|
a := NewAdaptor()
|
2022-11-20 19:22:26 +01:00
|
|
|
fs := a.sys.UseMockFilesystem(mockPaths)
|
2022-12-01 17:33:33 +01:00
|
|
|
if err := a.Connect(); err != nil {
|
|
|
|
panic(err)
|
|
|
|
}
|
2017-04-27 10:04:54 +02:00
|
|
|
return a, fs
|
2017-04-06 09:53:52 +02:00
|
|
|
}
|
|
|
|
|
2022-11-20 19:22:26 +01:00
|
|
|
func initTestProAdaptorWithMockedFilesystem() (*Adaptor, *system.MockFilesystem) {
|
2017-04-27 10:04:54 +02:00
|
|
|
a := NewProAdaptor()
|
2022-11-20 19:22:26 +01:00
|
|
|
fs := a.sys.UseMockFilesystem(mockPaths)
|
2022-12-01 17:33:33 +01:00
|
|
|
if err := a.Connect(); err != nil {
|
|
|
|
panic(err)
|
|
|
|
}
|
2017-04-27 10:04:54 +02:00
|
|
|
return a, fs
|
|
|
|
}
|
|
|
|
|
2022-11-05 07:42:28 +01:00
|
|
|
func TestName(t *testing.T) {
|
2017-04-27 10:04:54 +02:00
|
|
|
a := NewAdaptor()
|
2023-10-20 10:27:09 +02:00
|
|
|
assert.True(t, strings.HasPrefix(a.Name(), "CHIP"))
|
2017-04-27 10:04:54 +02:00
|
|
|
a.SetName("NewName")
|
2023-10-20 10:27:09 +02:00
|
|
|
assert.Equal(t, "NewName", a.Name())
|
2017-04-27 10:04:54 +02:00
|
|
|
}
|
|
|
|
|
2022-12-01 17:33:33 +01:00
|
|
|
func TestNewProAdaptor(t *testing.T) {
|
|
|
|
a := NewProAdaptor()
|
2023-10-20 10:27:09 +02:00
|
|
|
assert.True(t, strings.HasPrefix(a.Name(), "CHIP Pro"))
|
2017-04-27 11:22:15 +02:00
|
|
|
}
|
|
|
|
|
2022-11-05 07:42:28 +01:00
|
|
|
func TestFinalizeErrorAfterGPIO(t *testing.T) {
|
|
|
|
a, fs := initTestAdaptorWithMockedFilesystem()
|
2023-11-12 14:17:02 +01:00
|
|
|
require.NoError(t, a.DigitalWrite("CSID7", 1))
|
2017-04-27 11:22:15 +02:00
|
|
|
|
|
|
|
fs.WithWriteError = true
|
|
|
|
|
|
|
|
err := a.Finalize()
|
2023-11-15 20:51:52 +01:00
|
|
|
require.ErrorContains(t, err, "write error")
|
2017-04-27 11:22:15 +02:00
|
|
|
}
|
|
|
|
|
2022-11-05 07:42:28 +01:00
|
|
|
func TestFinalizeErrorAfterPWM(t *testing.T) {
|
|
|
|
a, fs := initTestAdaptorWithMockedFilesystem()
|
2023-10-19 18:08:03 +02:00
|
|
|
fs.Files["/sys/class/pwm/pwmchip0/pwm0/duty_cycle"].Contents = "0"
|
|
|
|
fs.Files["/sys/class/pwm/pwmchip0/pwm0/period"].Contents = "0"
|
|
|
|
|
2023-11-12 14:17:02 +01:00
|
|
|
require.NoError(t, a.PwmWrite("PWM0", 100))
|
2017-04-27 11:22:15 +02:00
|
|
|
|
|
|
|
fs.WithWriteError = true
|
|
|
|
|
|
|
|
err := a.Finalize()
|
2023-11-15 20:51:52 +01:00
|
|
|
require.ErrorContains(t, err, "write error")
|
2017-04-27 11:22:15 +02:00
|
|
|
}
|
|
|
|
|
2022-11-05 07:42:28 +01:00
|
|
|
func TestDigitalIO(t *testing.T) {
|
|
|
|
a, fs := initTestAdaptorWithMockedFilesystem()
|
2016-01-30 02:00:27 -08:00
|
|
|
|
2023-12-05 20:26:28 +01:00
|
|
|
require.NoError(t, a.DigitalWrite("CSID7", 1))
|
2023-10-20 10:27:09 +02:00
|
|
|
assert.Equal(t, "1", fs.Files["/sys/class/gpio/gpio139/value"].Contents)
|
2016-01-30 02:00:27 -08:00
|
|
|
|
2017-01-11 22:21:07 +01:00
|
|
|
fs.Files["/sys/class/gpio/gpio50/value"].Contents = "1"
|
|
|
|
i, _ := a.DigitalRead("TWI2-SDA")
|
2023-10-20 10:27:09 +02:00
|
|
|
assert.Equal(t, 1, i)
|
2016-01-30 02:00:27 -08:00
|
|
|
|
2023-11-12 14:17:02 +01:00
|
|
|
require.ErrorContains(t, a.DigitalWrite("XIO-P10", 1), "'XIO-P10' is not a valid id for a digital pin")
|
|
|
|
require.NoError(t, a.Finalize())
|
2016-01-30 02:00:27 -08:00
|
|
|
}
|
|
|
|
|
2022-11-05 07:42:28 +01:00
|
|
|
func TestProDigitalIO(t *testing.T) {
|
|
|
|
a, fs := initTestProAdaptorWithMockedFilesystem()
|
2023-06-12 19:51:25 +02:00
|
|
|
_ = a.Connect()
|
2017-04-22 13:34:19 +02:00
|
|
|
|
2023-06-12 19:51:25 +02:00
|
|
|
_ = a.DigitalWrite("CSID7", 1)
|
2023-10-20 10:27:09 +02:00
|
|
|
assert.Equal(t, "1", fs.Files["/sys/class/gpio/gpio139/value"].Contents)
|
2017-04-22 13:34:19 +02:00
|
|
|
|
|
|
|
fs.Files["/sys/class/gpio/gpio50/value"].Contents = "1"
|
|
|
|
i, _ := a.DigitalRead("TWI2-SDA")
|
2023-10-20 10:27:09 +02:00
|
|
|
assert.Equal(t, 1, i)
|
2017-04-22 13:34:19 +02:00
|
|
|
|
2023-11-12 14:17:02 +01:00
|
|
|
require.ErrorContains(t, a.DigitalWrite("XIO-P0", 1), "'XIO-P0' is not a valid id for a digital pin")
|
|
|
|
require.NoError(t, a.Finalize())
|
2017-04-22 13:34:19 +02:00
|
|
|
}
|
|
|
|
|
2023-12-05 20:26:28 +01:00
|
|
|
func TestPWMWrite(t *testing.T) {
|
|
|
|
// arrange
|
2022-11-05 07:42:28 +01:00
|
|
|
a, fs := initTestAdaptorWithMockedFilesystem()
|
2023-10-19 18:08:03 +02:00
|
|
|
fs.Files["/sys/class/pwm/pwmchip0/pwm0/duty_cycle"].Contents = "0"
|
|
|
|
fs.Files["/sys/class/pwm/pwmchip0/pwm0/period"].Contents = "0"
|
2023-12-05 20:26:28 +01:00
|
|
|
// act
|
2017-04-22 10:41:47 +02:00
|
|
|
err := a.PwmWrite("PWM0", 100)
|
2023-12-05 20:26:28 +01:00
|
|
|
// assert
|
2023-11-12 14:17:02 +01:00
|
|
|
require.NoError(t, err)
|
2023-10-20 10:27:09 +02:00
|
|
|
assert.Equal(t, "0", fs.Files["/sys/class/pwm/pwmchip0/export"].Contents)
|
|
|
|
assert.Equal(t, "1", fs.Files["/sys/class/pwm/pwmchip0/pwm0/enable"].Contents)
|
|
|
|
assert.Equal(t, "3921568", fs.Files["/sys/class/pwm/pwmchip0/pwm0/duty_cycle"].Contents)
|
|
|
|
assert.Equal(t, "10000000", fs.Files["/sys/class/pwm/pwmchip0/pwm0/period"].Contents) // pwmPeriodDefault
|
|
|
|
assert.Equal(t, "normal", fs.Files["/sys/class/pwm/pwmchip0/pwm0/polarity"].Contents)
|
2017-03-14 00:11:06 +01:00
|
|
|
|
2023-12-05 20:26:28 +01:00
|
|
|
require.NoError(t, a.Finalize())
|
|
|
|
}
|
2017-04-22 11:50:39 +02:00
|
|
|
|
2023-12-05 20:26:28 +01:00
|
|
|
func TestServoWrite(t *testing.T) {
|
|
|
|
// arrange: prepare 50Hz for servos
|
|
|
|
const (
|
|
|
|
pin = "PWM0"
|
|
|
|
fiftyHzNano = 20000000
|
|
|
|
)
|
|
|
|
a := NewAdaptor(adaptors.WithPWMDefaultPeriodForPin(pin, fiftyHzNano))
|
|
|
|
fs := a.sys.UseMockFilesystem(mockPaths)
|
|
|
|
require.NoError(t, a.Connect())
|
|
|
|
fs.Files["/sys/class/pwm/pwmchip0/pwm0/duty_cycle"].Contents = "0"
|
|
|
|
fs.Files["/sys/class/pwm/pwmchip0/pwm0/period"].Contents = "0"
|
|
|
|
// act & assert for 0° (min default value)
|
|
|
|
err := a.ServoWrite(pin, 0)
|
|
|
|
require.NoError(t, err)
|
|
|
|
assert.Equal(t, strconv.Itoa(fiftyHzNano), fs.Files["/sys/class/pwm/pwmchip0/pwm0/period"].Contents)
|
2023-10-20 10:27:09 +02:00
|
|
|
assert.Equal(t, "500000", fs.Files["/sys/class/pwm/pwmchip0/pwm0/duty_cycle"].Contents)
|
2023-12-05 20:26:28 +01:00
|
|
|
// act & assert for 180° (max default value)
|
|
|
|
err = a.ServoWrite(pin, 180)
|
2023-11-12 14:17:02 +01:00
|
|
|
require.NoError(t, err)
|
2023-12-05 20:26:28 +01:00
|
|
|
assert.Equal(t, strconv.Itoa(fiftyHzNano), fs.Files["/sys/class/pwm/pwmchip0/pwm0/period"].Contents)
|
2023-12-03 18:03:02 +01:00
|
|
|
assert.Equal(t, "2500000", fs.Files["/sys/class/pwm/pwmchip0/pwm0/duty_cycle"].Contents)
|
2023-10-19 18:08:03 +02:00
|
|
|
|
2023-11-12 14:17:02 +01:00
|
|
|
require.NoError(t, a.Finalize())
|
2017-03-14 00:11:06 +01:00
|
|
|
}
|
2017-04-11 18:35:18 +02:00
|
|
|
|
2022-12-08 19:29:51 +01:00
|
|
|
func TestI2cDefaultBus(t *testing.T) {
|
|
|
|
a := NewAdaptor()
|
2023-10-20 10:27:09 +02:00
|
|
|
assert.Equal(t, 1, a.DefaultI2cBus())
|
2022-12-08 19:29:51 +01:00
|
|
|
}
|
|
|
|
|
|
|
|
func TestI2cFinalizeWithErrors(t *testing.T) {
|
|
|
|
// arrange
|
|
|
|
a := NewAdaptor()
|
|
|
|
a.sys.UseMockSyscall()
|
|
|
|
fs := a.sys.UseMockFilesystem([]string{"/dev/i2c-2"})
|
2023-11-12 14:17:02 +01:00
|
|
|
require.NoError(t, a.Connect())
|
2022-12-10 13:10:23 +01:00
|
|
|
con, err := a.GetI2cConnection(0xff, 2)
|
2023-11-12 14:17:02 +01:00
|
|
|
require.NoError(t, err)
|
2022-12-08 19:29:51 +01:00
|
|
|
_, err = con.Write([]byte{0xbf})
|
2023-11-12 14:17:02 +01:00
|
|
|
require.NoError(t, err)
|
2022-12-08 19:29:51 +01:00
|
|
|
fs.WithCloseError = true
|
|
|
|
// act
|
|
|
|
err = a.Finalize()
|
|
|
|
// assert
|
2023-11-15 20:51:52 +01:00
|
|
|
require.ErrorContains(t, err, "close error")
|
2017-04-11 18:35:18 +02:00
|
|
|
}
|
|
|
|
|
2022-12-08 19:29:51 +01:00
|
|
|
func Test_validateI2cBusNumber(t *testing.T) {
|
2023-10-20 20:50:42 +02:00
|
|
|
tests := map[string]struct {
|
2022-12-08 19:29:51 +01:00
|
|
|
busNr int
|
|
|
|
wantErr error
|
|
|
|
}{
|
|
|
|
"number_negative_error": {
|
|
|
|
busNr: -1,
|
|
|
|
wantErr: fmt.Errorf("Bus number -1 out of range"),
|
|
|
|
},
|
|
|
|
"number_0_ok": {
|
|
|
|
busNr: 0,
|
|
|
|
},
|
|
|
|
"number_1_ok": {
|
|
|
|
busNr: 1,
|
|
|
|
},
|
|
|
|
"number_2_ok": {
|
|
|
|
busNr: 2,
|
|
|
|
},
|
|
|
|
"number_3_error": {
|
|
|
|
busNr: 3,
|
|
|
|
wantErr: fmt.Errorf("Bus number 3 out of range"),
|
|
|
|
},
|
|
|
|
}
|
|
|
|
for name, tc := range tests {
|
|
|
|
t.Run(name, func(t *testing.T) {
|
|
|
|
// arrange
|
|
|
|
a := NewAdaptor()
|
|
|
|
// act
|
|
|
|
err := a.validateI2cBusNumber(tc.busNr)
|
|
|
|
// assert
|
2023-10-20 10:27:09 +02:00
|
|
|
assert.Equal(t, tc.wantErr, err)
|
2022-12-08 19:29:51 +01:00
|
|
|
})
|
|
|
|
}
|
2017-04-11 18:35:18 +02:00
|
|
|
}
|
2022-12-05 18:28:57 +01:00
|
|
|
|
|
|
|
func Test_translatePWMPin(t *testing.T) {
|
2023-10-20 20:50:42 +02:00
|
|
|
tests := map[string]struct {
|
2022-12-05 18:28:57 +01:00
|
|
|
usePro bool
|
|
|
|
wantDir string
|
|
|
|
wantChannel int
|
|
|
|
wantErr error
|
|
|
|
}{
|
|
|
|
"PWM0": {
|
|
|
|
wantDir: "/sys/class/pwm/pwmchip0",
|
|
|
|
wantChannel: 0,
|
|
|
|
},
|
|
|
|
"PWM1": {
|
|
|
|
usePro: true,
|
|
|
|
wantDir: "/sys/class/pwm/pwmchip0",
|
|
|
|
wantChannel: 1,
|
|
|
|
},
|
|
|
|
"33_1": {
|
|
|
|
wantDir: "",
|
|
|
|
wantChannel: -1,
|
|
|
|
wantErr: fmt.Errorf("'33_1' is not a valid id for a pin"),
|
|
|
|
},
|
|
|
|
"AP-EINT3": {
|
|
|
|
wantDir: "",
|
|
|
|
wantChannel: -1,
|
|
|
|
wantErr: fmt.Errorf("'AP-EINT3' is not a valid id for a PWM pin"),
|
|
|
|
},
|
|
|
|
}
|
|
|
|
for name, tc := range tests {
|
|
|
|
t.Run(name, func(t *testing.T) {
|
|
|
|
// arrange
|
|
|
|
var a *Adaptor
|
|
|
|
if tc.usePro {
|
|
|
|
a = NewProAdaptor()
|
|
|
|
} else {
|
|
|
|
a = NewAdaptor()
|
|
|
|
}
|
|
|
|
// act
|
|
|
|
dir, channel, err := a.translatePWMPin(name)
|
|
|
|
// assert
|
2023-10-20 10:27:09 +02:00
|
|
|
assert.Equal(t, tc.wantErr, err)
|
|
|
|
assert.Equal(t, tc.wantDir, dir)
|
|
|
|
assert.Equal(t, tc.wantChannel, channel)
|
2022-12-05 18:28:57 +01:00
|
|
|
})
|
|
|
|
}
|
|
|
|
}
|