57 lines
1.3 KiB
Go
57 lines
1.3 KiB
Go
package i2c
|
|
|
|
import "gobot.io/x/gobot"
|
|
|
|
var _ gobot.Driver = (*HMC6352Driver)(nil)
|
|
|
|
const hmc6352Address = 0x21
|
|
|
|
type HMC6352Driver struct {
|
|
name string
|
|
connection I2c
|
|
}
|
|
|
|
// NewHMC6352Driver creates a new driver with specified i2c interface
|
|
func NewHMC6352Driver(a I2c) *HMC6352Driver {
|
|
return &HMC6352Driver{
|
|
name: "HMC6352",
|
|
connection: a,
|
|
}
|
|
}
|
|
|
|
func (h *HMC6352Driver) Name() string { return h.name }
|
|
func (h *HMC6352Driver) SetName(n string) { h.name = n }
|
|
func (h *HMC6352Driver) Connection() gobot.Connection { return h.connection.(gobot.Connection) }
|
|
|
|
// Start initialized the hmc6352
|
|
func (h *HMC6352Driver) Start() (err error) {
|
|
if err := h.connection.I2cStart(hmc6352Address); err != nil {
|
|
return err
|
|
}
|
|
if err := h.connection.I2cWrite(hmc6352Address, []byte("A")); err != nil {
|
|
return err
|
|
}
|
|
return
|
|
}
|
|
|
|
// Halt returns true if devices is halted successfully
|
|
func (h *HMC6352Driver) Halt() (err error) { return }
|
|
|
|
// Heading returns the current heading
|
|
func (h *HMC6352Driver) Heading() (heading uint16, err error) {
|
|
if err = h.connection.I2cWrite(hmc6352Address, []byte("A")); err != nil {
|
|
return
|
|
}
|
|
ret, err := h.connection.I2cRead(hmc6352Address, 2)
|
|
if err != nil {
|
|
return
|
|
}
|
|
if len(ret) == 2 {
|
|
heading = (uint16(ret[1]) + uint16(ret[0])*256) / 10
|
|
return
|
|
} else {
|
|
err = ErrNotEnoughBytes
|
|
}
|
|
return
|
|
}
|