mirror of
https://github.com/kidoman/embd
synced 2024-12-22 04:40:04 +01:00
remove the old spi driver
This commit is contained in:
Karan Misra
parent
6342dd3a19
commit
ca17879e6e
195
spi/spi.go
195
spi/spi.go
@ -1,195 +0,0 @@
|
||||
package spi
|
||||
|
||||
import (
|
||||
"fmt"
|
||||
"log"
|
||||
"os"
|
||||
"sync"
|
||||
"syscall"
|
||||
"unsafe"
|
||||
)
|
||||
|
||||
const (
|
||||
SPI_CPHA = 0x01
|
||||
SPI_CPOL = 0x02
|
||||
|
||||
SPI_MODE_0 = (0 | 0)
|
||||
SPI_MODE_1 = (0 | SPI_CPHA)
|
||||
SPI_MODE_2 = (SPI_CPOL | 0)
|
||||
SPI_MODE_3 = (SPI_CPOL | SPI_CPHA)
|
||||
|
||||
SPI_IOC_WR_MODE = 0x40016B01
|
||||
SPI_IOC_WR_BITS_PER_WORD = 0x40016B03
|
||||
SPI_IOC_WR_MAX_SPEED_HZ = 0x40046B04
|
||||
|
||||
SPI_IOC_RD_MODE = 0x80016B01
|
||||
SPI_IOC_RD_BITS_PER_WORD = 0x80016B03
|
||||
SPI_IOC_RD_MAX_SPEED_HZ = 0x80046B04
|
||||
|
||||
SPI_IOC_MESSAGE_0 = 1073769216 //0x40006B00
|
||||
SPI_IOC_INCREMENTER = 2097152 //0x200000
|
||||
)
|
||||
|
||||
type SpiBus interface {
|
||||
TransferAndRecieveByteData(byte) (uint8, error)
|
||||
}
|
||||
|
||||
type spiBus struct {
|
||||
file *os.File
|
||||
mode byte
|
||||
mu sync.Mutex
|
||||
}
|
||||
|
||||
type spiMode struct {
|
||||
mode uintptr
|
||||
}
|
||||
|
||||
type spiIocTransfer struct {
|
||||
tx_buf uint64
|
||||
rx_buf uint64
|
||||
|
||||
length uint32
|
||||
speed_hz uint32
|
||||
delay_usecs uint16
|
||||
bits_per_word uint8
|
||||
}
|
||||
|
||||
func spi_ioc_message_n(n uint32) uint32 {
|
||||
return (SPI_IOC_MESSAGE_0 + (n * SPI_IOC_INCREMENTER))
|
||||
}
|
||||
|
||||
func NewSpiBus() (SpiBus, error) {
|
||||
var b *spiBus
|
||||
var err error
|
||||
b = new(spiBus)
|
||||
|
||||
fmt.Println("Opening SPI device.")
|
||||
b.file, err = os.OpenFile("/dev/spidev0.1", os.O_EXCL, os.ModeExclusive)
|
||||
|
||||
if err != nil {
|
||||
fmt.Print("spi: Could not open SPI device due to ")
|
||||
fmt.Println(err.Error())
|
||||
return nil, err
|
||||
} else {
|
||||
fmt.Println("spi: Successfully initialized spiBus")
|
||||
fmt.Println("spi: File Fd = ", b.file.Fd())
|
||||
}
|
||||
|
||||
var mode uint8
|
||||
mode = 0
|
||||
_, _, errno := syscall.Syscall(syscall.SYS_IOCTL, b.file.Fd(), SPI_IOC_RD_MODE, uintptr(unsafe.Pointer(&mode)))
|
||||
|
||||
if errno != 0 {
|
||||
fmt.Println(syscall.Errno(errno))
|
||||
err = syscall.Errno(errno)
|
||||
return nil, err
|
||||
} else {
|
||||
fmt.Println("Successfully read the mode")
|
||||
fmt.Println(mode)
|
||||
}
|
||||
|
||||
_, _, errno = syscall.Syscall(syscall.SYS_IOCTL, b.file.Fd(), SPI_IOC_WR_MODE, uintptr(unsafe.Pointer(&mode)))
|
||||
|
||||
if errno != 0 {
|
||||
fmt.Println(syscall.Errno(errno))
|
||||
err = syscall.Errno(errno)
|
||||
return nil, err
|
||||
} else {
|
||||
fmt.Println("Successfully read the mode")
|
||||
fmt.Println(mode)
|
||||
}
|
||||
|
||||
var speed_max uint32
|
||||
speed_max = 5000000
|
||||
_, _, errno = syscall.Syscall(syscall.SYS_IOCTL, b.file.Fd(), SPI_IOC_RD_MAX_SPEED_HZ, uintptr(unsafe.Pointer(&speed_max)))
|
||||
|
||||
if errno != 0 {
|
||||
fmt.Println(syscall.Errno(errno))
|
||||
err = syscall.Errno(errno)
|
||||
return nil, err
|
||||
} else {
|
||||
fmt.Println("Successfully read the speed")
|
||||
fmt.Println(speed_max)
|
||||
}
|
||||
|
||||
_, _, errno = syscall.Syscall(syscall.SYS_IOCTL, b.file.Fd(), SPI_IOC_WR_MAX_SPEED_HZ, uintptr(unsafe.Pointer(&speed_max)))
|
||||
|
||||
if errno != 0 {
|
||||
fmt.Println(syscall.Errno(errno))
|
||||
err = syscall.Errno(errno)
|
||||
return nil, err
|
||||
} else {
|
||||
fmt.Println("Successfully read the speed")
|
||||
fmt.Println(speed_max)
|
||||
}
|
||||
|
||||
var bps uint32
|
||||
bps = 8
|
||||
_, _, errno = syscall.Syscall(syscall.SYS_IOCTL, b.file.Fd(), SPI_IOC_RD_BITS_PER_WORD, uintptr(unsafe.Pointer(&bps)))
|
||||
|
||||
if errno != 0 {
|
||||
fmt.Println(syscall.Errno(errno))
|
||||
err = syscall.Errno(errno)
|
||||
return nil, err
|
||||
} else {
|
||||
fmt.Println("Successfully read the bps")
|
||||
fmt.Println(bps)
|
||||
}
|
||||
|
||||
_, _, errno = syscall.Syscall(syscall.SYS_IOCTL, b.file.Fd(), SPI_IOC_WR_BITS_PER_WORD, uintptr(unsafe.Pointer(&bps)))
|
||||
|
||||
if errno != 0 {
|
||||
fmt.Println(syscall.Errno(errno))
|
||||
err = syscall.Errno(errno)
|
||||
return nil, err
|
||||
} else {
|
||||
fmt.Println("Successfully wrote the bps")
|
||||
fmt.Println(bps)
|
||||
}
|
||||
|
||||
var bpw uint32
|
||||
bpw = 8
|
||||
_, _, errno = syscall.Syscall(syscall.SYS_IOCTL, b.file.Fd(), SPI_IOC_RD_BITS_PER_WORD, uintptr(unsafe.Pointer(&bpw)))
|
||||
|
||||
if errno != 0 {
|
||||
fmt.Println(syscall.Errno(errno))
|
||||
err = syscall.Errno(errno)
|
||||
return nil, err
|
||||
} else {
|
||||
fmt.Println("Successfully read the bpw")
|
||||
fmt.Println(bpw)
|
||||
}
|
||||
|
||||
_, _, errno = syscall.Syscall(syscall.SYS_IOCTL, b.file.Fd(), SPI_IOC_WR_BITS_PER_WORD, uintptr(unsafe.Pointer(&bpw)))
|
||||
|
||||
if errno != 0 {
|
||||
fmt.Println(syscall.Errno(errno))
|
||||
err = syscall.Errno(errno)
|
||||
return nil, err
|
||||
} else {
|
||||
fmt.Println("Successfully read the bpw")
|
||||
fmt.Println(bpw)
|
||||
}
|
||||
|
||||
return b, err
|
||||
}
|
||||
|
||||
func (b *spiBus) TransferAndRecieveByteData(tx_data uint8) (rx_data uint8, err error) {
|
||||
var data spiIocTransfer
|
||||
|
||||
data.delay_usecs = 0
|
||||
data.length = 8
|
||||
data.speed_hz = 5000000
|
||||
data.bits_per_word = 8
|
||||
data.tx_buf = uint64(uintptr(unsafe.Pointer(&tx_data)))
|
||||
data.rx_buf = uint64(uintptr(unsafe.Pointer(&rx_data)))
|
||||
|
||||
_, _, errno := syscall.Syscall(syscall.SYS_IOCTL, b.file.Fd(), uintptr(spi_ioc_message_n(1)), uintptr(unsafe.Pointer(&data)))
|
||||
if errno != 0 {
|
||||
err = syscall.Errno(errno)
|
||||
return 0, nil
|
||||
}
|
||||
|
||||
log.Println("Successfully read the data")
|
||||
return rx_data, nil
|
||||
}
|
||||
Loading…
x
Reference in New Issue
Block a user