def Start(self, buff_num):
if self.verbose:
print '==== START ===='
req = v4l2.v4l2_requestbuffers()
req.count = buff_num
req.type = v4l2.V4L2_BUF_TYPE_VIDEO_CAPTURE
req.memory = v4l2.V4L2_MEMORY_MMAP
xioctl(self.vd, v4l2.VIDIOC_REQBUFS, req)
if self.verbose:
print '--requesetbuffers success'
n_buffers = req.count
self.buffers = list()
for i in range(n_buffers):
self.buffers.append(buffer_struct())
for i in range(n_buffers):
buf = v4l2.v4l2_buffer()
buf.type = v4l2.V4L2_BUF_TYPE_VIDEO_CAPTURE
buf.memory = v4l2.V4L2_MEMORY_MMAP
buf.index = i
xioctl(self.vd, v4l2.VIDIOC_QUERYBUF, buf)
self.buffers[i].length = buf.length
self.buffers[i].start = mmap.mmap(self.vd.fileno(),
buf.length,
flags=mmap.MAP_SHARED,
prot=mmap.PROT_READ
| mmap.PROT_WRITE,
offset=buf.m.offset)
if self.verbose:
print '--Memory MAP'
print ' +MMAP:', i, buf.m.offset, buf.length
for i in range(n_buffers):
buf = v4l2.v4l2_buffer()
buf.type = v4l2.V4L2_BUF_TYPE_VIDEO_CAPTURE
buf.memory = v4l2.V4L2_MEMORY_MMAP
buf.index = i
xioctl(self.vd, v4l2.VIDIOC_QBUF, buf)
if self.verbose:
print '--requesetbuffers success'
buftype = v4l2.v4l2_buf_type(v4l2.V4L2_BUF_TYPE_VIDEO_CAPTURE)
xioctl(self.vd, v4l2.VIDIOC_STREAMON, buftype)
time.sleep(1)
buftype = v4l2.v4l2_buf_type(v4l2.V4L2_BUF_TYPE_VIDEO_CAPTURE)
xioctl(self.vd, v4l2.VIDIOC_STREAMON, buftype)
if self.verbose:
print '**** START ****'
def Stop(self):
buftype = v4l2.v4l2_buf_type(v4l2.V4L2_BUF_TYPE_VIDEO_CAPTURE)
xioctl(self.vd, v4l2.VIDIOC_STREAMOFF, buftype)
for buf_st in self.buffers:
buf_st.start.close()
if self.verbose:
print '**** STOP ****'
def close(self):
#streamoff
l.debug("streamoff")
buf_type = v4l2.v4l2_buf_type(v4l2.V4L2_BUF_TYPE_VIDEO_CAPTURE)
fcntl.ioctl(self.vd, v4l2.VIDIOC_STREAMOFF, buf_type)
#close
l.debug("close")
self.vd.close()
def close(self):
#streamoff
l.debug("streamoff")
buf_type = v4l2.v4l2_buf_type(v4l2.V4L2_BUF_TYPE_VIDEO_CAPTURE)
fcntl.ioctl(self.vd, v4l2.VIDIOC_STREAMOFF, buf_type)
#close
l.debug("close")
self.vd.close()
def _start(self):
self.buf_type = v4l2.v4l2_buf_type(v4l2.V4L2_BUF_TYPE_VIDEO_CAPTURE)
fcntl.ioctl(self.fd, v4l2.VIDIOC_STREAMON, self.buf_type)
def __init__(self):
self.W = 1920
self.H = 1080
self.controls = {}
#open
l.debug("open")
self.vd = open('/dev/video0', 'rb+', buffering=0)
#queryctrl/g_ctrl
qctrl = v4l2.v4l2_queryctrl()
ctrl = v4l2.v4l2_control()
#brightness
qctrl.id = v4l2.V4L2_CID_BRIGHTNESS
try:
fcntl.ioctl(self.vd, v4l2.VIDIOC_QUERYCTRL, qctrl)
ctrl.id = qctrl.id
fcntl.ioctl(self.vd, v4l2.VIDIOC_G_CTRL, ctrl)
except:
l.error("QUERYCTRL/G_CTRL failed")
self.controls["brightness"] = (ctrl.id, ctrl.value, qctrl.minimum,
qctrl.maximum)
#exposure
qctrl.id = v4l2.V4L2_CID_EXPOSURE_ABSOLUTE
try:
fcntl.ioctl(self.vd, v4l2.VIDIOC_QUERYCTRL, qctrl)
ctrl.id = qctrl.id
fcntl.ioctl(self.vd, v4l2.VIDIOC_G_CTRL, ctrl)
except:
l.error("QUERYCTRL/G_CTRL failed")
self.controls["exposure"] = (ctrl.id, ctrl.value, qctrl.minimum,
qctrl.maximum)
#querycap
l.debug("querycap")
cp = v4l2.v4l2_capability()
fcntl.ioctl(self.vd, v4l2.VIDIOC_QUERYCAP, cp)
#s_fmt
l.debug("s_fmt")
fmt = v4l2.v4l2_format()
fmt.type = v4l2.V4L2_BUF_TYPE_VIDEO_CAPTURE
fmt.fmt.pix.width = self.W
fmt.fmt.pix.height = self.H
fmt.fmt.pix.pixelformat = v4l2.V4L2_PIX_FMT_SBGGR10
fmt.fmt.pix.field = v4l2.V4L2_FIELD_NONE
fcntl.ioctl(self.vd, v4l2.VIDIOC_S_FMT, fmt)
#g_fmt
fmt = v4l2.v4l2_format()
fmt.type = v4l2.V4L2_BUF_TYPE_VIDEO_CAPTURE
fcntl.ioctl(self.vd, v4l2.VIDIOC_G_FMT, fmt)
self.framesize = fmt.fmt.pix.sizeimage
#reqbufs
l.debug("reqbufs")
req = v4l2.v4l2_requestbuffers()
req.type = v4l2.V4L2_BUF_TYPE_VIDEO_CAPTURE
req.memory = v4l2.V4L2_MEMORY_MMAP
req.count = 4
fcntl.ioctl(self.vd, v4l2.VIDIOC_REQBUFS, req)
self.buffers = []
for ind in range(req.count):
#querybufs
buf = v4l2.v4l2_buffer()
buf.type = v4l2.V4L2_BUF_TYPE_VIDEO_CAPTURE
buf.memory = v4l2.V4L2_MEMORY_MMAP
buf.index = ind
fcntl.ioctl(self.vd, v4l2.VIDIOC_QUERYBUF, buf)
#mmap
mm = mmap.mmap(self.vd.fileno(),
buf.length,
mmap.MAP_SHARED,
mmap.PROT_READ | mmap.PROT_WRITE,
offset=buf.m.offset)
self.buffers.append(mm)
#qbuf
fcntl.ioctl(self.vd, v4l2.VIDIOC_QBUF, buf)
#streamon
l.debug("streamon")
buf_type = v4l2.v4l2_buf_type(v4l2.V4L2_BUF_TYPE_VIDEO_CAPTURE)
fcntl.ioctl(self.vd, v4l2.VIDIOC_STREAMON, buf_type)
#select
l.debug("select")
t0 = time.time()
max_t = 1
ready_to_read, ready_to_write, in_error = ([], [], [])
while len(ready_to_read) == 0 and time.time() - t0 < max_t:
ready_to_read, ready_to_write, in_error = select.select([self.vd],
[], [],
max_t)
def stop(self):
buf_type = v4l2.v4l2_buf_type(v4l2.V4L2_BUF_TYPE_VIDEO_CAPTURE)
fcntl.ioctl(self, v4l2.VIDIOC_STREAMOFF, buf_type)
def __init__(self):
self.W = 1920
self.H = 1080
self.controls = {}
#open
l.debug("open")
self.vd = open('/dev/video0', 'rb+', buffering=0)
#queryctrl/g_ctrl
qctrl = v4l2.v4l2_queryctrl()
ctrl = v4l2.v4l2_control()
#brightness
qctrl.id = v4l2.V4L2_CID_BRIGHTNESS
try:
fcntl.ioctl(self.vd, v4l2.VIDIOC_QUERYCTRL, qctrl)
ctrl.id = qctrl.id
fcntl.ioctl(self.vd, v4l2.VIDIOC_G_CTRL, ctrl)
except:
l.error("QUERYCTRL/G_CTRL failed")
self.controls["brightness"] = (ctrl.id, ctrl.value, qctrl.minimum, qctrl.maximum)
#exposure
qctrl.id = v4l2.V4L2_CID_EXPOSURE_ABSOLUTE
try:
fcntl.ioctl(self.vd, v4l2.VIDIOC_QUERYCTRL, qctrl)
ctrl.id = qctrl.id
fcntl.ioctl(self.vd, v4l2.VIDIOC_G_CTRL, ctrl)
except:
l.error("QUERYCTRL/G_CTRL failed")
self.controls["exposure"] = (ctrl.id, ctrl.value, qctrl.minimum, qctrl.maximum)
#querycap
l.debug("querycap")
cp = v4l2.v4l2_capability()
fcntl.ioctl(self.vd, v4l2.VIDIOC_QUERYCAP, cp)
#s_fmt
l.debug("s_fmt")
fmt = v4l2.v4l2_format()
fmt.type = v4l2.V4L2_BUF_TYPE_VIDEO_CAPTURE
fmt.fmt.pix.width = self.W
fmt.fmt.pix.height = self.H
fmt.fmt.pix.pixelformat = v4l2.V4L2_PIX_FMT_SBGGR10
fmt.fmt.pix.field = v4l2.V4L2_FIELD_NONE
fcntl.ioctl(self.vd, v4l2.VIDIOC_S_FMT, fmt)
#g_fmt
fmt = v4l2.v4l2_format()
fmt.type = v4l2.V4L2_BUF_TYPE_VIDEO_CAPTURE
fcntl.ioctl(self.vd, v4l2.VIDIOC_G_FMT, fmt)
self.framesize = fmt.fmt.pix.sizeimage
#reqbufs
l.debug("reqbufs")
req = v4l2.v4l2_requestbuffers()
req.type = v4l2.V4L2_BUF_TYPE_VIDEO_CAPTURE
req.memory = v4l2.V4L2_MEMORY_MMAP
req.count = 4
fcntl.ioctl(self.vd, v4l2.VIDIOC_REQBUFS, req)
self.buffers = []
for ind in range(req.count):
#querybufs
buf = v4l2.v4l2_buffer()
buf.type = v4l2.V4L2_BUF_TYPE_VIDEO_CAPTURE
buf.memory = v4l2.V4L2_MEMORY_MMAP
buf.index = ind
fcntl.ioctl(self.vd, v4l2.VIDIOC_QUERYBUF, buf)
#mmap
mm = mmap.mmap(self.vd.fileno(), buf.length, mmap.MAP_SHARED, mmap.PROT_READ | mmap.PROT_WRITE, offset=buf.m.offset)
self.buffers.append(mm)
#qbuf
fcntl.ioctl(self.vd, v4l2.VIDIOC_QBUF, buf)
#streamon
l.debug("streamon")
buf_type = v4l2.v4l2_buf_type(v4l2.V4L2_BUF_TYPE_VIDEO_CAPTURE)
fcntl.ioctl(self.vd, v4l2.VIDIOC_STREAMON, buf_type)
#select
l.debug("select")
t0 = time.time()
max_t = 1
ready_to_read, ready_to_write, in_error = ([], [], [])
while len(ready_to_read) == 0 and time.time() - t0 < max_t:
ready_to_read, ready_to_write, in_error = select.select([self.vd], [], [], max_t)
def _start_capture(self):
buftype = v4l2.v4l2_buf_type(v4l2.V4L2_BUF_TYPE_VIDEO_CAPTURE)
if fcntl.ioctl(self.camera, v4l2.VIDIOC_STREAMON, buftype):
print 'Failed to start capture...'
def stopStream(self): if not self.available: return streamType = v4l2.v4l2_buf_type(v4l2.V4L2_BUF_TYPE_VIDEO_CAPTURE) fcntl.ioctl(self.device, v4l2.VIDIOC_STREAMOFF, streamType)
