2014-04-28 07:58:34 +08:00
|
|
|
package opencv
|
|
|
|
|
|
|
|
import (
|
2014-11-20 07:59:17 +08:00
|
|
|
"errors"
|
|
|
|
|
2014-04-28 07:58:34 +08:00
|
|
|
cv "github.com/hybridgroup/go-opencv/opencv"
|
|
|
|
"github.com/hybridgroup/gobot"
|
2014-11-17 02:32:51 +08:00
|
|
|
"time"
|
2014-04-28 07:58:34 +08:00
|
|
|
)
|
|
|
|
|
2014-11-17 04:25:48 +08:00
|
|
|
var _ gobot.DriverInterface = (*CameraDriver)(nil)
|
|
|
|
|
2014-04-28 07:58:34 +08:00
|
|
|
type CameraDriver struct {
|
|
|
|
gobot.Driver
|
2014-07-24 07:38:46 +08:00
|
|
|
camera capture
|
2014-05-23 11:53:15 +08:00
|
|
|
Source interface{}
|
2014-11-20 07:59:17 +08:00
|
|
|
start func(*CameraDriver) (err error)
|
2014-04-28 07:58:34 +08:00
|
|
|
}
|
|
|
|
|
2014-10-21 00:23:33 +08:00
|
|
|
// NewCameraDriver creates a new driver with specified name and source.
|
|
|
|
// It also creates a start function to either set camera as a File or Camera capture.
|
2014-05-23 11:53:15 +08:00
|
|
|
func NewCameraDriver(name string, source interface{}) *CameraDriver {
|
2014-07-08 08:31:35 +08:00
|
|
|
c := &CameraDriver{
|
|
|
|
Driver: *gobot.NewDriver(
|
|
|
|
name,
|
|
|
|
"CameraDriver",
|
|
|
|
),
|
2014-05-23 11:53:15 +08:00
|
|
|
Source: source,
|
2014-11-20 07:59:17 +08:00
|
|
|
start: func(c *CameraDriver) (err error) {
|
2014-07-24 07:38:46 +08:00
|
|
|
switch v := c.Source.(type) {
|
|
|
|
case string:
|
|
|
|
c.camera = cv.NewFileCapture(v)
|
|
|
|
case int:
|
|
|
|
c.camera = cv.NewCameraCapture(v)
|
|
|
|
default:
|
2014-11-20 07:59:17 +08:00
|
|
|
return errors.New("Unknown camera source")
|
2014-07-24 07:38:46 +08:00
|
|
|
}
|
2014-11-20 07:59:17 +08:00
|
|
|
return
|
2014-07-24 07:38:46 +08:00
|
|
|
},
|
2014-04-28 07:58:34 +08:00
|
|
|
}
|
2014-07-08 08:31:35 +08:00
|
|
|
|
|
|
|
c.AddEvent("frame")
|
|
|
|
|
|
|
|
return c
|
2014-04-28 07:58:34 +08:00
|
|
|
}
|
|
|
|
|
2014-10-21 00:23:33 +08:00
|
|
|
// Start initializes camera by grabbing a frame
|
|
|
|
// every `interval` and publishing an frame event
|
2014-11-20 15:21:19 +08:00
|
|
|
func (c *CameraDriver) Start() (errs []error) {
|
|
|
|
if err := c.start(c); err != nil {
|
|
|
|
return []error{err}
|
2014-11-20 07:59:17 +08:00
|
|
|
}
|
2014-11-17 02:32:51 +08:00
|
|
|
go func() {
|
|
|
|
for {
|
|
|
|
if c.camera.GrabFrame() {
|
|
|
|
image := c.camera.RetrieveFrame(1)
|
|
|
|
if image != nil {
|
|
|
|
gobot.Publish(c.Event("frame"), image)
|
|
|
|
}
|
2014-04-28 07:58:34 +08:00
|
|
|
}
|
2014-11-17 02:32:51 +08:00
|
|
|
<-time.After(c.Interval())
|
2014-04-28 07:58:34 +08:00
|
|
|
}
|
2014-11-17 02:32:51 +08:00
|
|
|
}()
|
2014-11-21 09:54:48 +08:00
|
|
|
return
|
2014-04-28 07:58:34 +08:00
|
|
|
}
|
|
|
|
|
2014-10-21 00:23:33 +08:00
|
|
|
// Halt stops camera driver
|
2014-11-20 15:21:19 +08:00
|
|
|
func (c *CameraDriver) Halt() (errs []error) { return }
|