mirror of
https://github.com/kidoman/embd
synced 2024-12-22 04:40:04 +01:00
gpio: adding interrupt
this is inspired by Dave Cheney's gpio library and his work on EPOLL
This commit is contained in:
parent
6ad940090c
commit
0fa1d1b61c
22
gpio.go
22
gpio.go
@ -7,6 +7,9 @@ import "time"
|
|||||||
// The Direction type indicates the direction of a GPIO pin.
|
// The Direction type indicates the direction of a GPIO pin.
|
||||||
type Direction int
|
type Direction int
|
||||||
|
|
||||||
|
// The Edge trigger for the GPIO Interrupt
|
||||||
|
type Edge string
|
||||||
|
|
||||||
const (
|
const (
|
||||||
// In represents read mode.
|
// In represents read mode.
|
||||||
In Direction = iota
|
In Direction = iota
|
||||||
@ -23,8 +26,27 @@ const (
|
|||||||
High
|
High
|
||||||
)
|
)
|
||||||
|
|
||||||
|
const (
|
||||||
|
EdgeNone Edge = "none"
|
||||||
|
EdgeRising Edge = "rising"
|
||||||
|
EdgeFalling Edge = "falling"
|
||||||
|
EdgeBoth Edge = "both"
|
||||||
|
)
|
||||||
|
|
||||||
|
// InterruptPin implements access to a Interruptable capable GPIO pin.
|
||||||
|
type InterruptPin interface {
|
||||||
|
|
||||||
|
// Start watching this pin for interrupt
|
||||||
|
Watch(edge Edge, handler func(DigitalPin)) error
|
||||||
|
|
||||||
|
// Stop watching this pin for interrupt
|
||||||
|
StopWatching() error
|
||||||
|
}
|
||||||
|
|
||||||
// DigitalPin implements access to a digital IO capable GPIO pin.
|
// DigitalPin implements access to a digital IO capable GPIO pin.
|
||||||
type DigitalPin interface {
|
type DigitalPin interface {
|
||||||
|
InterruptPin
|
||||||
|
|
||||||
// N returns the logical GPIO number.
|
// N returns the logical GPIO number.
|
||||||
N() int
|
N() int
|
||||||
|
|
||||||
|
@ -228,6 +228,10 @@ func (p *digitalPin) PullDown() error {
|
|||||||
}
|
}
|
||||||
|
|
||||||
func (p *digitalPin) Close() error {
|
func (p *digitalPin) Close() error {
|
||||||
|
if err := p.StopWatching(); err != nil {
|
||||||
|
return err
|
||||||
|
}
|
||||||
|
|
||||||
if err := p.drv.Unregister(p.id); err != nil {
|
if err := p.drv.Unregister(p.id); err != nil {
|
||||||
return err
|
return err
|
||||||
}
|
}
|
||||||
@ -253,3 +257,25 @@ func (p *digitalPin) Close() error {
|
|||||||
|
|
||||||
return nil
|
return nil
|
||||||
}
|
}
|
||||||
|
|
||||||
|
func (p *digitalPin) setEdge(edge embd.Edge) error {
|
||||||
|
file, err := p.openFile(path.Join(p.basePath(), "edge"))
|
||||||
|
if err != nil {
|
||||||
|
return err
|
||||||
|
}
|
||||||
|
defer file.Close()
|
||||||
|
|
||||||
|
_, err = file.Write([]byte(edge))
|
||||||
|
return err
|
||||||
|
}
|
||||||
|
|
||||||
|
func (p *digitalPin) Watch(edge embd.Edge, handler func(embd.DigitalPin)) error {
|
||||||
|
if err := p.setEdge(edge); err != nil {
|
||||||
|
return err
|
||||||
|
}
|
||||||
|
return registerInterrupt(p, handler)
|
||||||
|
}
|
||||||
|
|
||||||
|
func (p *digitalPin) StopWatching() error {
|
||||||
|
return unregisterInterrupt(p)
|
||||||
|
}
|
||||||
|
126
host/generic/interrupt.go
Normal file
126
host/generic/interrupt.go
Normal file
@ -0,0 +1,126 @@
|
|||||||
|
// Generic Interrupt Pins.
|
||||||
|
|
||||||
|
package generic
|
||||||
|
|
||||||
|
import (
|
||||||
|
"errors"
|
||||||
|
"fmt"
|
||||||
|
"sync"
|
||||||
|
"syscall"
|
||||||
|
|
||||||
|
"github.com/kidoman/embd"
|
||||||
|
)
|
||||||
|
|
||||||
|
const (
|
||||||
|
MaxGPIOInterrupt = 64
|
||||||
|
)
|
||||||
|
|
||||||
|
var ErrorPinAlreadyRegistered = errors.New("pin interrupt already registered")
|
||||||
|
|
||||||
|
type interrupt struct {
|
||||||
|
pin embd.DigitalPin
|
||||||
|
initialTrigger bool
|
||||||
|
handler func(embd.DigitalPin)
|
||||||
|
}
|
||||||
|
|
||||||
|
func (i *interrupt) Signal() {
|
||||||
|
if !i.initialTrigger {
|
||||||
|
i.initialTrigger = true
|
||||||
|
return
|
||||||
|
}
|
||||||
|
i.handler(i.pin)
|
||||||
|
}
|
||||||
|
|
||||||
|
type ePollListener struct {
|
||||||
|
epollFd int
|
||||||
|
interruptablePins map[int]*interrupt
|
||||||
|
mu sync.Mutex
|
||||||
|
}
|
||||||
|
|
||||||
|
var ePollListenerInstance *ePollListener
|
||||||
|
|
||||||
|
func getEPollListenerInstance() *ePollListener {
|
||||||
|
if ePollListenerInstance == nil {
|
||||||
|
ePollListenerInstance = initEPollListener()
|
||||||
|
}
|
||||||
|
return ePollListenerInstance
|
||||||
|
}
|
||||||
|
|
||||||
|
func initEPollListener() *ePollListener {
|
||||||
|
epollFd, err := syscall.EpollCreate1(0)
|
||||||
|
if err != nil {
|
||||||
|
panic(fmt.Sprintf("Unable to create epoll: %v", err))
|
||||||
|
}
|
||||||
|
listener := &ePollListener{epollFd: epollFd, interruptablePins: make(map[int]*interrupt)}
|
||||||
|
|
||||||
|
go func() {
|
||||||
|
var epollEvents [MaxGPIOInterrupt]syscall.EpollEvent
|
||||||
|
|
||||||
|
for {
|
||||||
|
n, err := syscall.EpollWait(listener.epollFd, epollEvents[:], -1)
|
||||||
|
if err != nil {
|
||||||
|
panic(fmt.Sprintf("EpollWait error: %v", err))
|
||||||
|
}
|
||||||
|
for i := 0; i < n; i++ {
|
||||||
|
if irq, ok := listener.interruptablePins[int(epollEvents[i].Fd)]; ok {
|
||||||
|
irq.Signal()
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}()
|
||||||
|
return listener
|
||||||
|
}
|
||||||
|
|
||||||
|
func registerInterrupt(pin *digitalPin, handler func(embd.DigitalPin)) error {
|
||||||
|
l := getEPollListenerInstance()
|
||||||
|
|
||||||
|
pinFd := int(pin.val.Fd())
|
||||||
|
|
||||||
|
l.mu.Lock()
|
||||||
|
defer l.mu.Unlock()
|
||||||
|
|
||||||
|
if _, ok := l.interruptablePins[pinFd]; ok {
|
||||||
|
return ErrorPinAlreadyRegistered
|
||||||
|
}
|
||||||
|
|
||||||
|
var event syscall.EpollEvent
|
||||||
|
event.Events = syscall.EPOLLIN | (syscall.EPOLLET & 0xffffffff) | syscall.EPOLLPRI
|
||||||
|
|
||||||
|
if err := syscall.SetNonblock(pinFd, true); err != nil {
|
||||||
|
return err
|
||||||
|
}
|
||||||
|
|
||||||
|
event.Fd = int32(pinFd)
|
||||||
|
|
||||||
|
if err := syscall.EpollCtl(l.epollFd, syscall.EPOLL_CTL_ADD, pinFd, &event); err != nil {
|
||||||
|
return err
|
||||||
|
}
|
||||||
|
|
||||||
|
l.interruptablePins[pinFd] = &interrupt{pin: pin, handler: handler}
|
||||||
|
|
||||||
|
return nil
|
||||||
|
}
|
||||||
|
|
||||||
|
func unregisterInterrupt(pin *digitalPin) error {
|
||||||
|
l := getEPollListenerInstance()
|
||||||
|
|
||||||
|
pinFd := int(pin.val.Fd())
|
||||||
|
|
||||||
|
l.mu.Lock()
|
||||||
|
defer l.mu.Unlock()
|
||||||
|
|
||||||
|
if _, ok := l.interruptablePins[pinFd]; !ok {
|
||||||
|
return nil
|
||||||
|
}
|
||||||
|
|
||||||
|
if err := syscall.EpollCtl(l.epollFd, syscall.EPOLL_CTL_DEL, pinFd, nil); err != nil {
|
||||||
|
return err
|
||||||
|
}
|
||||||
|
|
||||||
|
if err := syscall.SetNonblock(pinFd, false); err != nil {
|
||||||
|
return err
|
||||||
|
}
|
||||||
|
|
||||||
|
delete(l.interruptablePins, pinFd)
|
||||||
|
return nil
|
||||||
|
}
|
42
samples/gpiointerrupt.go
Normal file
42
samples/gpiointerrupt.go
Normal file
@ -0,0 +1,42 @@
|
|||||||
|
// +build ignore
|
||||||
|
|
||||||
|
package main
|
||||||
|
|
||||||
|
import (
|
||||||
|
"flag"
|
||||||
|
"fmt"
|
||||||
|
|
||||||
|
"github.com/kidoman/embd"
|
||||||
|
|
||||||
|
_ "github.com/kidoman/embd/host/all"
|
||||||
|
)
|
||||||
|
|
||||||
|
func main() {
|
||||||
|
flag.Parse()
|
||||||
|
|
||||||
|
if err := embd.InitGPIO(); err != nil {
|
||||||
|
panic(err)
|
||||||
|
}
|
||||||
|
defer embd.CloseGPIO()
|
||||||
|
|
||||||
|
btn, err := embd.NewDigitalPin(10)
|
||||||
|
if err != nil {
|
||||||
|
panic(err)
|
||||||
|
}
|
||||||
|
defer btn.Close()
|
||||||
|
|
||||||
|
if err := btn.SetDirection(embd.In); err != nil {
|
||||||
|
panic(err)
|
||||||
|
}
|
||||||
|
btn.ActiveLow(false)
|
||||||
|
|
||||||
|
quit := make(chan interface{})
|
||||||
|
err = btn.Watch(embd.EdgeFalling, func(btn embd.DigitalPin) {
|
||||||
|
quit <- btn
|
||||||
|
})
|
||||||
|
if err != nil {
|
||||||
|
panic(err)
|
||||||
|
}
|
||||||
|
|
||||||
|
fmt.Printf("Button %v was pressed.\n", <-quit)
|
||||||
|
}
|
Loading…
x
Reference in New Issue
Block a user