生活随笔
收集整理的這篇文章主要介紹了
自己写的uvc驱动支持IP2977/ip2970
小編覺得挺不錯(cuò)的,現(xiàn)在分享給大家,幫大家做個(gè)參考.
?????????#include?<linux?kernel=""?h="">??#include?<linux?list=""?h="">??#include?<linux?module=""?h="">??#include?<linux?usb=""?h="">??#include?<linux?videodev2=""?h="">??#include?<linux?vmalloc=""?h="">??#include?<linux?wait=""?h="">??#include?<linux?mm=""?h="">??#include?<asm?atomic=""?h="">??#include?<asm?unaligned=""?h="">????#include?<media?v4l2-common=""?h="">??#include?<media?v4l2-ioctl=""?h="">??#include?<media?videobuf-core=""?h="">????#include?"uvcvideo.h"????????#define?MYUVC_URBS?5??????#define?UVC_STREAM_EOH??(1?<<?7)??#define?UVC_STREAM_ERR??(1?<<?6)??#define?UVC_STREAM_STI??(1?<<?5)??#define?UVC_STREAM_RES??(1?<<?4)??#define?UVC_STREAM_SCR??(1?<<?3)??#define?UVC_STREAM_PTS??(1?<<?2)??#define?UVC_STREAM_EOF??(1?<<?1)??#define?UVC_STREAM_FID??(1?<<?0)??????struct?myuvc_streaming_control?{??????__u16?bmHint;??????__u8??bFormatIndex;??????__u8??bFrameIndex;??????__u32?dwFrameInterval;??????__u16?wKeyFrameRate;??????__u16?wPFrameRate;??????__u16?wCompQuality;??????__u16?wCompWindowSize;??????__u16?wDelay;??????__u32?dwMaxVideoFrameSize;??????__u32?dwMaxPayloadTransferSize;??????__u32?dwClockFrequency;??????__u8??bmFramingInfo;??????__u8??bPreferedVersion;??????__u8??bMinVersion;??????__u8??bMaxVersion;??};????????struct?frame_desc?{??????int?width;??????int?height;??};??????struct?myuvc_buffer?{??????????struct?v4l2_buffer?buf;??????int?state;??????int?vma_use_count;???????wait_queue_head_t?wait;????????struct?list_head?stream;??????struct?list_head?irq;??????};????struct?myuvc_queue?{??????void?*mem;??????int?count;??????int?buf_size;??????????struct?myuvc_buffer?buffer[32];????????struct?urb?*urb[32];??????char?*urb_buffer[32];??????dma_addr_t?urb_dma[32];??????unsigned?int?urb_size;????????struct?list_head?mainqueue;?????????struct?list_head?irqqueue;??????};????static?struct?myuvc_queue?myuvc_queue;????static?struct?video_device?*myuvc_vdev;??static?struct?usb_device?*myuvc_udev;????static?int?myuvc_bEndpointAddress?=?0x82;??static?int?myuvc_streaming_intf;??static?int?myuvc_control_intf;??static?struct?v4l2_format?myuvc_format;????static?struct?frame_desc?frames[]?=?{{640,?480},?{320,?240},?{160,?120}};??static?int?frame_idx?=?1;??static?int?bBitsPerPixel?=?0;???static?int?uvc_version?=?0x0100;?????static?int?ProcessingUnitID?=?3;????????static?int?wMaxPacketSize?=?800;??static?int?myuvc_streaming_bAlternateSetting?=?5;??static?int?dwMaxVideoFrameSize?=?77312;????static?struct?myuvc_streaming_control?myuvc_params;????static?int?last_fid?=?-1;??????static?int?myuvc_vidioc_querycap(struct?file?*file,?void??*priv,??????????????????????struct?v4l2_capability?*cap)??{??????????memset(cap,?0,?sizeof?*cap);??????strcpy(cap->driver,?"myuvc");??????strcpy(cap->card,?"myuvc");??????cap->version?=?1;????????????cap->capabilities?=?V4L2_CAP_VIDEO_CAPTURE?|?V4L2_CAP_STREAMING;?????????return?0;??}????????static?int?myuvc_vidioc_enum_fmt_vid_cap(struct?file?*file,?void??*priv,??????????????????????struct?v4l2_fmtdesc?*f)??{????????????if?(f->index?>=?1)??????????return?-EINVAL;????????strcpy(f->description,?"MJPEG");??????f->pixelformat?=?V4L2_PIX_FMT_MJPEG;????????????????f->type????????=?V4L2_BUF_TYPE_VIDEO_CAPTURE;????????????return?0;??}??????static?int?myuvc_vidioc_g_fmt_vid_cap(struct?file?*file,?void?*priv,??????????????????????struct?v4l2_format?*f)??{??????memcpy(f,?&myuvc_format,?sizeof(myuvc_format));??????return?(0);??}?????????static?int?myuvc_vidioc_try_fmt_vid_cap(struct?file?*file,?void?*priv,??????????????struct?v4l2_format?*f)??{??????if?(f->type?!=?V4L2_BUF_TYPE_VIDEO_CAPTURE)??????{??????????return?-EINVAL;??????}????????if?(f->fmt.pix.pixelformat?!=?V4L2_PIX_FMT_MJPEG)??????????return?-EINVAL;????????????????????????????f->fmt.pix.width??=?frames[frame_idx].width;??????f->fmt.pix.height?=?frames[frame_idx].height;??????????????f->fmt.pix.bytesperline?=??????????(f->fmt.pix.width?*?bBitsPerPixel)?>>?3;??????????????????f->fmt.pix.sizeimage?=?dwMaxVideoFrameSize;????????f->fmt.pix.field??????=?V4L2_FIELD_NONE;????????????f->fmt.pix.colorspace?=?V4L2_COLORSPACE_SRGB;??????f->fmt.pix.priv???????=?0;???????????????????return?0;??}??????static?int?myuvc_vidioc_s_fmt_vid_cap(struct?file?*file,?void?*priv,??????????????????????struct?v4l2_format?*f)??{??????int?ret?=?myuvc_vidioc_try_fmt_vid_cap(file,?NULL,?f);??????if?(ret?<?0)??????????return?ret;????????memcpy(&myuvc_format,?f,?sizeof(myuvc_format));????????????return?0;??}????static?int?myuvc_free_buffers(void)??{??????if?(myuvc_queue.mem)??????{??????????vfree(myuvc_queue.mem);??????????memset(&myuvc_queue,?0,?sizeof(myuvc_queue));??????????myuvc_queue.mem?=?NULL;??????}??????return?0;??}????????static?int?myuvc_vidioc_reqbufs(struct?file?*file,?void?*priv,????????????????struct?v4l2_requestbuffers?*p)??{??????int?nbuffers?=?p->count;??????int?bufsize??=?PAGE_ALIGN(myuvc_format.fmt.pix.sizeimage);??????unsigned?int?i;??????void?*mem?=?NULL;??????int?ret;????????if?((ret?=?myuvc_free_buffers())?<?0)??????????goto?done;??????????????if?(nbuffers?==?0)??????????goto?done;??????????????for?(;?nbuffers?>?0;?--nbuffers)?{??????????mem?=?vmalloc_32(nbuffers?*?bufsize);??????????if?(mem?!=?NULL)??????????????break;??????}????????if?(mem?==?NULL)?{??????????ret?=?-ENOMEM;??????????goto?done;??????}??????????????memset(&myuvc_queue,?0,?sizeof(myuvc_queue));????????INIT_LIST_HEAD(&myuvc_queue.mainqueue);??????INIT_LIST_HEAD(&myuvc_queue.irqqueue);????????for?(i?=?0;?i?<?nbuffers;?++i)?{??????????myuvc_queue.buffer[i].buf.index?=?i;??????????myuvc_queue.buffer[i].buf.m.offset?=?i?*?bufsize;??????????myuvc_queue.buffer[i].buf.length?=?myuvc_format.fmt.pix.sizeimage;??????????myuvc_queue.buffer[i].buf.type?=?V4L2_BUF_TYPE_VIDEO_CAPTURE;??????????myuvc_queue.buffer[i].buf.sequence?=?0;??????????myuvc_queue.buffer[i].buf.field?=?V4L2_FIELD_NONE;??????????myuvc_queue.buffer[i].buf.memory?=?V4L2_MEMORY_MMAP;??????????myuvc_queue.buffer[i].buf.flags?=?0;??????????myuvc_queue.buffer[i].state?????=?VIDEOBUF_IDLE;??????????init_waitqueue_head(&myuvc_queue.buffer[i].wait);??????}????????myuvc_queue.mem?=?mem;??????myuvc_queue.count?=?nbuffers;??????myuvc_queue.buf_size?=?bufsize;??????ret?=?nbuffers;????done:??????return?ret;??}????????static?int?myuvc_vidioc_querybuf(struct?file?*file,?void?*priv,?struct?v4l2_buffer?*v4l2_buf)??{??????int?ret?=?0;????????????if?(v4l2_buf->index?>=?myuvc_queue.count)?{??????????ret?=?-EINVAL;??????????goto?done;??????}????????memcpy(v4l2_buf,?&myuvc_queue.buffer[v4l2_buf->index].buf,?sizeof(*v4l2_buf));??????????????if?(myuvc_queue.buffer[v4l2_buf->index].vma_use_count)??????????v4l2_buf->flags?|=?V4L2_BUF_FLAG_MAPPED;??????????switch?(myuvc_queue.buffer[v4l2_buf->index].state)?{??????????case?VIDEOBUF_ERROR:??????????case?VIDEOBUF_DONE:??????????????v4l2_buf->flags?|=?V4L2_BUF_FLAG_DONE;??????????????break;??????????case?VIDEOBUF_QUEUED:??????????case?VIDEOBUF_ACTIVE:??????????????v4l2_buf->flags?|=?V4L2_BUF_FLAG_QUEUED;??????????????break;??????????case?VIDEOBUF_IDLE:??????????default:??????????????break;??????}????done:??????????return?ret;??}????????static?int?myuvc_vidioc_qbuf(struct?file?*file,?void?*priv,?struct?v4l2_buffer?*v4l2_buf)??{??????struct?myuvc_buffer?*buf;????????????????if?(v4l2_buf->type?!=?V4L2_BUF_TYPE_VIDEO_CAPTURE?||??????????v4l2_buf->memory?!=?V4L2_MEMORY_MMAP)?{??????????return?-EINVAL;??????}????????if?(v4l2_buf->index?>=?myuvc_queue.count)?{??????????return?-EINVAL;??????}????????buf?=?&myuvc_queue.buffer[v4l2_buf->index];????????if?(buf->state?!=?VIDEOBUF_IDLE)?{??????????return?-EINVAL;??????}????????????????buf->state?=?VIDEOBUF_QUEUED;??????buf->buf.bytesused?=?0;???????????????????????list_add_tail(&buf->stream,?&myuvc_queue.mainqueue);????????????????list_add_tail(&buf->irq,?&myuvc_queue.irqqueue);????????????return?0;??}????static?void?myuvc_print_streaming_params(struct?myuvc_streaming_control?*ctrl)??{??????printk("video?params:\n");??????printk("bmHint???????????????????=?%d\n",?ctrl->bmHint);??????printk("bFormatIndex?????????????=?%d\n",?ctrl->bFormatIndex);??????printk("bFrameIndex??????????????=?%d\n",?ctrl->bFrameIndex);??????printk("dwFrameInterval??????????=?%d\n",?ctrl->dwFrameInterval);??????printk("wKeyFrameRate????????????=?%d\n",?ctrl->wKeyFrameRate);??????printk("wPFrameRate??????????????=?%d\n",?ctrl->wPFrameRate);??????printk("wCompQuality?????????????=?%d\n",?ctrl->wCompQuality);??????printk("wCompWindowSize??????????=?%d\n",?ctrl->wCompWindowSize);??????printk("wDelay???????????????????=?%d\n",?ctrl->wDelay);??????printk("dwMaxVideoFrameSize??????=?%d\n",?ctrl->dwMaxVideoFrameSize);??????printk("dwMaxPayloadTransferSize?=?%d\n",?ctrl->dwMaxPayloadTransferSize);??????printk("dwClockFrequency?????????=?%d\n",?ctrl->dwClockFrequency);??????printk("bmFramingInfo????????????=?%d\n",?ctrl->bmFramingInfo);??????printk("bPreferedVersion?????????=?%d\n",?ctrl->bPreferedVersion);??????printk("bMinVersion??????????????=?%d\n",?ctrl->bMinVersion);??????printk("bMinVersion??????????????=?%d\n",?ctrl->bMinVersion);??}????????????static?int?myuvc_get_streaming_params(struct?myuvc_streaming_control?*ctrl)??{??????__u8?*data;??????__u16?size;??????int?ret;??????__u8?type?=?USB_TYPE_CLASS?|?USB_RECIP_INTERFACE;??????unsigned?int?pipe;????????size?=?uvc_version?>=?0x0110???34?:?26;??????data?=?kmalloc(size,?GFP_KERNEL);??????if?(data?==?NULL)??????????return?-ENOMEM;???????????pipe?=?(GET_CUR?&?0x80)???usb_rcvctrlpipe(myuvc_udev,?0)????????????????????:?usb_sndctrlpipe(myuvc_udev,?0);??????type?|=?(GET_CUR?&?0x80)???USB_DIR_IN?:?USB_DIR_OUT;????????ret?=?usb_control_msg(myuvc_udev,?pipe,?GET_CUR,?type,?VS_PROBE_CONTROL?<<?8,??????????????0?<<?8?|?myuvc_streaming_intf,?data,?size,?5000);????????if?(ret?<?0)??????????goto?done;????????ctrl->bmHint?=?le16_to_cpup((__le16?*)&data[0]);??????ctrl->bFormatIndex?=?data[2];??????ctrl->bFrameIndex?=?data[3];??????ctrl->dwFrameInterval?=?le32_to_cpup((__le32?*)&data[4]);??????ctrl->wKeyFrameRate?=?le16_to_cpup((__le16?*)&data[8]);??????ctrl->wPFrameRate?=?le16_to_cpup((__le16?*)&data[10]);??????ctrl->wCompQuality?=?le16_to_cpup((__le16?*)&data[12]);??????ctrl->wCompWindowSize?=?le16_to_cpup((__le16?*)&data[14]);??????ctrl->wDelay?=?le16_to_cpup((__le16?*)&data[16]);??????ctrl->dwMaxVideoFrameSize?=?get_unaligned_le32(&data[18]);??????ctrl->dwMaxPayloadTransferSize?=?get_unaligned_le32(&data[22]);????????if?(size?==?34)?{??????????ctrl->dwClockFrequency?=?get_unaligned_le32(&data[26]);??????????ctrl->bmFramingInfo?=?data[30];??????????ctrl->bPreferedVersion?=?data[31];??????????ctrl->bMinVersion?=?data[32];??????????ctrl->bMaxVersion?=?data[33];??????}?else?{????????????????????ctrl->bmFramingInfo?=?0;??????????ctrl->bPreferedVersion?=?0;??????????ctrl->bMinVersion?=?0;??????????ctrl->bMaxVersion?=?0;??????}????done:??????kfree(data);????????????return?(ret?<?0)???ret?:?0;??}????????static?int?myuvc_try_streaming_params(struct?myuvc_streaming_control?*ctrl)??{??????__u8?*data;??????__u16?size;??????int?ret;??????__u8?type?=?USB_TYPE_CLASS?|?USB_RECIP_INTERFACE;??????unsigned?int?pipe;????????????memset(ctrl,?0,?sizeof?*ctrl);????????????ctrl->bmHint?=?1;??????????ctrl->bFormatIndex?=?1;??????ctrl->bFrameIndex??=?frame_idx?+?1;??????ctrl->dwFrameInterval?=?333333;??????????size?=?uvc_version?>=?0x0110???34?:?26;??????data?=?kzalloc(size,?GFP_KERNEL);??????if?(data?==?NULL)??????????return?-ENOMEM;????????*(__le16?*)&data[0]?=?cpu_to_le16(ctrl->bmHint);??????data[2]?=?ctrl->bFormatIndex;??????data[3]?=?ctrl->bFrameIndex;??????*(__le32?*)&data[4]?=?cpu_to_le32(ctrl->dwFrameInterval);??????*(__le16?*)&data[8]?=?cpu_to_le16(ctrl->wKeyFrameRate);??????*(__le16?*)&data[10]?=?cpu_to_le16(ctrl->wPFrameRate);??????*(__le16?*)&data[12]?=?cpu_to_le16(ctrl->wCompQuality);??????*(__le16?*)&data[14]?=?cpu_to_le16(ctrl->wCompWindowSize);??????*(__le16?*)&data[16]?=?cpu_to_le16(ctrl->wDelay);??????put_unaligned_le32(ctrl->dwMaxVideoFrameSize,?&data[18]);??????put_unaligned_le32(ctrl->dwMaxPayloadTransferSize,?&data[22]);????????if?(size?==?34)?{??????????put_unaligned_le32(ctrl->dwClockFrequency,?&data[26]);??????????data[30]?=?ctrl->bmFramingInfo;??????????data[31]?=?ctrl->bPreferedVersion;??????????data[32]?=?ctrl->bMinVersion;??????????data[33]?=?ctrl->bMaxVersion;??????}????????pipe?=?(SET_CUR?&?0x80)???usb_rcvctrlpipe(myuvc_udev,?0)????????????????????:?usb_sndctrlpipe(myuvc_udev,?0);??????type?|=?(SET_CUR?&?0x80)???USB_DIR_IN?:?USB_DIR_OUT;????????ret?=?usb_control_msg(myuvc_udev,?pipe,?SET_CUR,?type,?VS_PROBE_CONTROL?<<?8,??????????????0?<<?8?|?myuvc_streaming_intf,?data,?size,?5000);????????kfree(data);????????????return?(ret?<?0)???ret?:?0;????????}??????????static?int?myuvc_set_streaming_params(struct?myuvc_streaming_control?*ctrl)??{??????__u8?*data;??????__u16?size;??????int?ret;??????__u8?type?=?USB_TYPE_CLASS?|?USB_RECIP_INTERFACE;??????unsigned?int?pipe;????????????size?=?uvc_version?>=?0x0110???34?:?26;??????data?=?kzalloc(size,?GFP_KERNEL);??????if?(data?==?NULL)??????????return?-ENOMEM;????????*(__le16?*)&data[0]?=?cpu_to_le16(ctrl->bmHint);??????data[2]?=?ctrl->bFormatIndex;??????data[3]?=?ctrl->bFrameIndex;??????*(__le32?*)&data[4]?=?cpu_to_le32(ctrl->dwFrameInterval);??????*(__le16?*)&data[8]?=?cpu_to_le16(ctrl->wKeyFrameRate);??????*(__le16?*)&data[10]?=?cpu_to_le16(ctrl->wPFrameRate);??????*(__le16?*)&data[12]?=?cpu_to_le16(ctrl->wCompQuality);??????*(__le16?*)&data[14]?=?cpu_to_le16(ctrl->wCompWindowSize);??????*(__le16?*)&data[16]?=?cpu_to_le16(ctrl->wDelay);??????put_unaligned_le32(ctrl->dwMaxVideoFrameSize,?&data[18]);??????put_unaligned_le32(ctrl->dwMaxPayloadTransferSize,?&data[22]);????????if?(size?==?34)?{??????????put_unaligned_le32(ctrl->dwClockFrequency,?&data[26]);??????????data[30]?=?ctrl->bmFramingInfo;??????????data[31]?=?ctrl->bPreferedVersion;??????????data[32]?=?ctrl->bMinVersion;??????????data[33]?=?ctrl->bMaxVersion;??????}????????pipe?=?(SET_CUR?&?0x80)???usb_rcvctrlpipe(myuvc_udev,?0)????????????????????:?usb_sndctrlpipe(myuvc_udev,?0);??????type?|=?(SET_CUR?&?0x80)???USB_DIR_IN?:?USB_DIR_OUT;????????ret?=?usb_control_msg(myuvc_udev,?pipe,?SET_CUR,?type,?VS_COMMIT_CONTROL?<<?8,??????????????0?<<?8?|?myuvc_streaming_intf,?data,?size,?5000);????????kfree(data);????????????return?(ret?<?0)???ret?:?0;????????}????static?void?myuvc_uninit_urbs(void)??{??????int?i;??????for?(i?=?0;?i?<?MYUVC_URBS;?++i)?{??????????if?(myuvc_queue.urb_buffer[i])??????????{??????????????usb_buffer_free(myuvc_udev,?myuvc_queue.urb_size,?myuvc_queue.urb_buffer[i],?myuvc_queue.urb_dma[i]);??????????????myuvc_queue.urb_buffer[i]?=?NULL;??????????}????????????if?(myuvc_queue.urb[i])??????????{??????????????usb_free_urb(myuvc_queue.urb[i]);??????????????myuvc_queue.urb[i]?=?NULL;??????????}??????}??}??????static?void?myuvc_video_complete(struct?urb?*urb)??{??????u8?*src;??????u8?*dest;??????int?ret,?i;??????int?len;??????int?maxlen;??????int?nbytes;??????struct?myuvc_buffer?*buf;??????static?int?fid;??????static?int?wake_cnt?=?0;??????????????unsigned?char?*point_mem;??????static?unsigned?char?*mem_temp?=?NULL;??????????????static?unsigned?int?nArrayTemp_Size?=?1000;????????u8*?mem;??????int?data_len;????????????switch?(urb->status)?{??????case?0:??????????break;????????default:??????????printk("Non-zero?status?(%d)?in?video?"??????????????"completion?handler.\n",?urb->status);??????????return;??????}??????????????if?(!list_empty(&myuvc_queue.irqqueue))??????{??????????buf?=?list_first_entry(&myuvc_queue.irqqueue,?struct?myuvc_buffer,?irq);??????}??????else??????{??????????????????????buf?=?NULL;??????}??????????????????for?(i?=?0;?i?<?urb->number_of_packets;?++i)?{??????????if?(urb->iso_frame_desc[i].status?<?0)?{??????????????????????????????????????????continue;??????????}????????????src??=?urb->transfer_buffer?+?urb->iso_frame_desc[i].offset;??????????????len?=?urb->iso_frame_desc[i].actual_length;?????????????????????????????????if?(len?<?2?||?src[0]?<?2?||?src[0]?>?len)??????????????continue;??????????????????????????????if?(src[1]?&?UVC_STREAM_ERR)?{????????????????????????????continue;??????????}????????????????????????if?(myuvc_udev->descriptor.idVendor?==?0x1B3B)??????????{??????????????if?(?len?>=?16?)???????????????{????????????????????????????????????if?(?(src[12]==0xFF?&&?src[13]==0xD8?&&?src[14]==0xFF)?||??????????????????????(src[12]==0xD8?&&?src[13]==0xFF?&&?src[14]==0xC4))???????????????????{??????????????????????if(last_fid)??????????????????????????fid?&=?~UVC_STREAM_FID;??????????????????????else??????????????????????????fid?|=?UVC_STREAM_FID;??????????????????}??????????????}??????????}??????????else??????????{??????????????fid?=?src[1]?&?UVC_STREAM_FID;??????????}????????????????????????if?(buf?==?NULL)?{??????????????last_fid?=?fid;??????????????continue;??????????}????????????????????????????????????if?(buf->state?!=?VIDEOBUF_ACTIVE)?{???????????????????????if?(fid?==?last_fid)?{????????????????????????????????????continue;??????????????}??????????????????????????????buf->state?=?VIDEOBUF_ACTIVE;??????????}??????????????????????????if?(fid?!=?last_fid?&&?buf->buf.bytesused?!=?0)?{??????????????buf->state?=?VIDEOBUF_DONE;??????????????????????????????list_del(&buf->irq);??????????????wake_up(&buf->wait);????????????????mem?=?myuvc_queue.mem?+?buf->buf.m.offset;??????????????data_len?=?buf->buf.bytesused;????????????????????????????????????????????if?(!list_empty(&myuvc_queue.irqqueue))??????????????{??????????????????buf?=?list_first_entry(&myuvc_queue.irqqueue,?struct?myuvc_buffer,?irq);??????????????}??????????????else??????????????{??????????????????buf?=?NULL;??????????????}??????????????continue;??????????}??????????last_fid?=?fid;????????????dest?=?myuvc_queue.mem?+?buf->buf.m.offset?+?buf->buf.bytesused;??????????????????????len?-=?src[0];??????????????????????maxlen?=?buf->buf.length?-?buf->buf.bytesused;??????????nbytes?=?min(len,?maxlen);??????????????????????memcpy(dest,?src?+?src[0],?nbytes);??????????buf->buf.bytesused?+=?nbytes;??????????????????????if?(myuvc_udev->descriptor.idVendor?==?0x1B3B)??????????{??????????????if(mem_temp?==?NULL)?{??????????????????mem_temp?=?kmalloc(nArrayTemp_Size,?GFP_KERNEL);??????????????}??????????????else?if(nArrayTemp_Size?<=?nbytes){???????????????????kfree(mem_temp);??????????????????nArrayTemp_Size?+=?500;??????????????????mem_temp?=?kmalloc(nArrayTemp_Size,?GFP_KERNEL);??????????????}??????????????memset(mem_temp,?0x00,?nArrayTemp_Size);??????????????????????????????????????????point_mem?=?(unsigned?char?*)dest;??????????????if(?*(point_mem)?==?0xD8?&&?*(point_mem?+?1)?==?0xFF?&&?*(point_mem?+?2)?==?0xC4){??????????????????memcpy(?mem_temp?+?1,?point_mem,?nbytes);??????????????????mem_temp[0]?=?0xFF;??????????????????memcpy(point_mem,?mem_temp,?nbytes?+?1);??????????????}??????????}????????????????????????????if?(len?>?maxlen)?{??????????????buf->state?=?VIDEOBUF_DONE;??????????}??????????????????????????????if?(src[1]?&?UVC_STREAM_EOF?&&?buf->buf.bytesused?!=?0)?{??????????????????????????????????????????????????????buf->state?=?VIDEOBUF_DONE;??????????}?????????????????????????if?(buf->state?==?VIDEOBUF_DONE?||??????????????buf->state?==?VIDEOBUF_ERROR)??????????{??????????????list_del(&buf->irq);??????????????wake_up(&buf->wait);????????????????mem?=?myuvc_queue.mem?+?buf->buf.m.offset;??????????????data_len?=?buf->buf.bytesused;????????????????????????????????????????????????????????if?(!list_empty(&myuvc_queue.irqqueue))??????????????{??????????????????buf?=?list_first_entry(&myuvc_queue.irqqueue,?struct?myuvc_buffer,?irq);??????????????}??????????????else??????????????{??????????????????buf?=?NULL;??????????????}??????????}????????}????????????????if?((ret?=?usb_submit_urb(urb,?GFP_ATOMIC))?<?0)?{??????????printk("Failed?to?resubmit?video?URB?(%d).\n",?ret);??????}??}??????static?int?myuvc_alloc_init_urbs(void)??{??????u16?psize;??????u32?size;??????int?npackets;??????int?i;??????int?j;????????struct?urb?*urb;????????psize?=?wMaxPacketSize;???????size??=?myuvc_params.dwMaxVideoFrameSize;????????npackets?=?DIV_ROUND_UP(size,?psize);??????if?(npackets?>?32)??????????npackets?=?32;????????size?=?myuvc_queue.urb_size?=?psize?*?npackets;????????????for?(i?=?0;?i?<?MYUVC_URBS;?++i)?{??????????????????????????????myuvc_queue.urb_buffer[i]?=?usb_buffer_alloc(??????????????myuvc_udev,?size,??????????????GFP_KERNEL?|?__GFP_NOWARN,?&myuvc_queue.urb_dma[i]);??????????????????????myuvc_queue.urb[i]?=?usb_alloc_urb(npackets,?GFP_KERNEL);????????????if?(!myuvc_queue.urb_buffer[i]?||?!myuvc_queue.urb[i])??????????{??????????????myuvc_uninit_urbs();??????????????return?-ENOMEM;??????????}????????}????????????????for?(i?=?0;?i?<?MYUVC_URBS;?++i)?{??????????urb?=?myuvc_queue.urb[i];????????????????????urb->dev?=?myuvc_udev;??????????urb->context?=?NULL;??????????urb->pipe?=?usb_rcvisocpipe(myuvc_udev,myuvc_bEndpointAddress);??????????urb->transfer_flags?=?URB_ISO_ASAP?|?URB_NO_TRANSFER_DMA_MAP;??????????urb->interval?=?1;??????????urb->transfer_buffer?=?myuvc_queue.urb_buffer[i];??????????urb->transfer_dma?=?myuvc_queue.urb_dma[i];??????????urb->complete?=?myuvc_video_complete;??????????urb->number_of_packets?=?npackets;??????????urb->transfer_buffer_length?=?size;????????????????????for?(j?=?0;?j?<?npackets;?++j)?{??????????????urb->iso_frame_desc[j].offset?=?j?*?psize;??????????????urb->iso_frame_desc[j].length?=?psize;??????????}????????????}????????????return?0;??}??????????static?int?myuvc_vidioc_streamon(struct?file?*file,?void?*priv,?enum?v4l2_buf_type?i)??{??????int?ret;??????????????????????????????ret?=?myuvc_try_streaming_params(&myuvc_params);??????printk("myuvc_try_streaming_params?ret?=?%d\n",?ret);??????????????ret?=?myuvc_get_streaming_params(&myuvc_params);??????printk("myuvc_get_streaming_params?ret?=?%d\n",?ret);??????????????ret?=?myuvc_set_streaming_params(&myuvc_params);??????printk("myuvc_set_streaming_params?ret?=?%d\n",?ret);????????????myuvc_print_streaming_params(&myuvc_params);?????????????????????????????usb_set_interface(myuvc_udev,?myuvc_streaming_intf,?myuvc_streaming_bAlternateSetting);??????????????????ret?=?myuvc_alloc_init_urbs();??????if?(ret)??????????printk("myuvc_alloc_init_urbs?err?:?ret?=?%d\n",?ret);??????????????for?(i?=?0;?i?<?MYUVC_URBS;?++i)?{??????????if?((ret?=?usb_submit_urb(myuvc_queue.urb[i],?GFP_KERNEL))?<?0)?{??????????????printk("Failed?to?submit?URB?%u?(%d).\n",?i,?ret);??????????????myuvc_uninit_urbs();??????????????return?ret;??????????}??????}????????????return?0;??}????????static?int?myuvc_vidioc_dqbuf(struct?file?*file,?void?*priv,?struct?v4l2_buffer?*v4l2_buf)??{??????????????struct?myuvc_buffer?*buf;??????int?ret?=?0;????????if?(list_empty(&myuvc_queue.mainqueue))?{??????????ret?=?-EINVAL;??????????goto?done;??????}????????????buf?=?list_first_entry(&myuvc_queue.mainqueue,?struct?myuvc_buffer,?stream);????????switch?(buf->state)?{??????case?VIDEOBUF_ERROR:??????????ret?=?-EIO;??????case?VIDEOBUF_DONE:??????????buf->state?=?VIDEOBUF_IDLE;??????????break;????????case?VIDEOBUF_IDLE:??????case?VIDEOBUF_QUEUED:??????case?VIDEOBUF_ACTIVE:??????default:??????????ret?=?-EINVAL;??????????goto?done;??????}????????list_del(&buf->stream);??????memcpy(v4l2_buf,?&buf->buf,?sizeof?*v4l2_buf);????????done:??????return?ret;??}????????????????static?int?myuvc_vidioc_streamoff(struct?file?*file,?void?*priv,?enum?v4l2_buf_type?t)??{??????struct?urb?*urb;??????unsigned?int?i;??????????????for?(i?=?0;?i?<?MYUVC_URBS;?++i)?{??????????if?((urb?=?myuvc_queue.urb[i])?==?NULL)??????????????continue;??????????usb_kill_urb(urb);??????}??????????????myuvc_uninit_urbs();??????????????usb_set_interface(myuvc_udev,?myuvc_streaming_intf,?0);????????????return?0;??}????????????????????static?__s32?myuvc_get_le_value(const?__u8?*data)??{??????int?bits?=?16;??????int?offset?=?0;??????__s32?value?=?0;??????__u8?mask;????????data?+=?offset?/?8;??????offset?&=?7;??????mask?=?((1LL?<<?bits)?-?1)?<<?offset;????????for?(;?bits?>?0;?data++)?{??????????__u8?byte?=?*data?&?mask;??????????value?|=?offset?>?0???(byte?>>?offset)?:?(byte?<<?(-offset));??????????bits?-=?8?-?(offset?>?0???offset?:?0);??????????offset?-=?8;??????????mask?=?(1?<<?bits)?-?1;??????}??????????????value?|=?-(value?&?(1?<<?(16?-?1)));????????return?value;??}????????static?void?myuvc_set_le_value(__s32?value,?__u8?*data)??{??????int?bits?=?16;??????int?offset?=?0;??????__u8?mask;????????data?+=?offset?/?8;??????offset?&=?7;????????for?(;?bits?>?0;?data++)?{??????????mask?=?((1LL?<<?bits)?-?1)?<<?offset;??????????*data?=?(*data?&?~mask)?|?((value?<<?offset)?&?mask);??????????value?>>=?offset???offset?:?8;??????????bits?-=?8?-?offset;??????????offset?=?0;??????}??}??????????????????int?myuvc_vidioc_queryctrl?(struct?file?*file,?void?*fh,??????????????????struct?v4l2_queryctrl?*ctrl)??{??????__u8?type?=?USB_TYPE_CLASS?|?USB_RECIP_INTERFACE;??????unsigned?int?pipe;??????int?ret;??????u8?data[2];????????if?(ctrl->id?!=?V4L2_CID_BRIGHTNESS)??????????return?-EINVAL;????????????memset(ctrl,?0,?sizeof?*ctrl);??????ctrl->id???=?V4L2_CID_BRIGHTNESS;??????ctrl->type?=?V4L2_CTRL_TYPE_INTEGER;??????strcpy(ctrl->name,?"MyUVC_BRIGHTNESS");??????ctrl->flags?=?0;????????pipe?=?usb_rcvctrlpipe(myuvc_udev,?0);??????type?|=?USB_DIR_IN;??????????????ret?=?usb_control_msg(myuvc_udev,?pipe,?GET_MIN,?type,?PU_BRIGHTNESS_CONTROL?<<?8,??????????????ProcessingUnitID?<<?8?|?myuvc_control_intf,?data,?2,?5000);??????if?(ret?!=?2)??????????return?-EIO;??????ctrl->minimum?=?myuvc_get_le_value(data);??????????????ret?=?usb_control_msg(myuvc_udev,?pipe,?GET_MAX,?type,??PU_BRIGHTNESS_CONTROL?<<?8,??????????????ProcessingUnitID?<<?8?|?myuvc_control_intf,?data,?2,?5000);??????if?(ret?!=?2)??????????return?-EIO;??????ctrl->maximum?=?myuvc_get_le_value(data);????????????ret?=?usb_control_msg(myuvc_udev,?pipe,?GET_RES,?type,?PU_BRIGHTNESS_CONTROL?<<?8,???????????????ProcessingUnitID?<<?8?|?myuvc_control_intf,?data,?2,?5000);??????if?(ret?!=?2)??????????return?-EIO;??????ctrl->step?=?myuvc_get_le_value(data);???????????ret?=?usb_control_msg(myuvc_udev,?pipe,?GET_DEF,?type,?PU_BRIGHTNESS_CONTROL?<<?8,??????????????ProcessingUnitID?<<?8?|?myuvc_control_intf,?data,?2,?5000);??????if?(ret?!=?2)??????????return?-EIO;??????ctrl->default_value?=?myuvc_get_le_value(data);??????????printk("Brightness:?min?=%d,?max?=?%d,?step?=?%d,?default?=?%d\n",?ctrl->minimum,?ctrl->maximum,?ctrl->step,?ctrl->default_value);????????????return?0;??}??????int?myuvc_vidioc_g_ctrl?(struct?file?*file,?void?*fh,??????????????????struct?v4l2_control?*ctrl)??{??????__u8?type?=?USB_TYPE_CLASS?|?USB_RECIP_INTERFACE;??????unsigned?int?pipe;??????int?ret;??????u8?data[2];????????????if?(ctrl->id?!=?V4L2_CID_BRIGHTNESS)??????????return?-EINVAL;????????pipe?=?usb_rcvctrlpipe(myuvc_udev,?0);??????type?|=?USB_DIR_IN;????????ret?=?usb_control_msg(myuvc_udev,?pipe,?GET_CUR,?type,?PU_BRIGHTNESS_CONTROL?<<?8,??????????????ProcessingUnitID?<<?8?|?myuvc_control_intf,?data,?2,?5000);??????if?(ret?!=?2)??????????return?-EIO;??????ctrl->value?=?myuvc_get_le_value(data);??????????????return?0;??}??????int?myuvc_vidioc_s_ctrl?(struct?file?*file,?void?*fh,??????????????????struct?v4l2_control?*ctrl)??{??????__u8?type?=?USB_TYPE_CLASS?|?USB_RECIP_INTERFACE;??????unsigned?int?pipe;??????int?ret;??????u8?data[2];????????????if?(ctrl->id?!=?V4L2_CID_BRIGHTNESS)??????????return?-EINVAL;????????myuvc_set_le_value(ctrl->value,?data);????????pipe?=?usb_sndctrlpipe(myuvc_udev,?0);??????type?|=?USB_DIR_OUT;????????ret?=?usb_control_msg(myuvc_udev,?pipe,?SET_CUR,?type,?PU_BRIGHTNESS_CONTROL?<<?8,??????????????ProcessingUnitID??<<?8?|?myuvc_control_intf,?data,?2,?5000);??????if?(ret?!=?2)??????????return?-EIO;????????????return?0;??}????????static?const?struct?v4l2_ioctl_ops?myuvc_ioctl_ops?=?{????????????????????.vidioc_querycap??????=?myuvc_vidioc_querycap,??????????????????????.vidioc_enum_fmt_vid_cap??=?myuvc_vidioc_enum_fmt_vid_cap,??????????.vidioc_g_fmt_vid_cap?????=?myuvc_vidioc_g_fmt_vid_cap,??????????.vidioc_try_fmt_vid_cap???=?myuvc_vidioc_try_fmt_vid_cap,??????????.vidioc_s_fmt_vid_cap?????=?myuvc_vidioc_s_fmt_vid_cap,??????????????????????????????.vidioc_reqbufs???????=?myuvc_vidioc_reqbufs,??????????.vidioc_querybuf??????=?myuvc_vidioc_querybuf,??????????.vidioc_qbuf??????????=?myuvc_vidioc_qbuf,??????????.vidioc_dqbuf?????????=?myuvc_vidioc_dqbuf,??????????????????????.vidioc_queryctrl?????=?myuvc_vidioc_queryctrl,??????????.vidioc_g_ctrl????????=?myuvc_vidioc_g_ctrl,??????????.vidioc_s_ctrl????????=?myuvc_vidioc_s_ctrl,??????????????????????????????.vidioc_streamon??????=?myuvc_vidioc_streamon,??????????.vidioc_streamoff?????=?myuvc_vidioc_streamoff,?????};??????static?int?myuvc_open(struct?file?*file)??{??????return?0;??}????static?void?myuvc_vm_open(struct?vm_area_struct?*vma)??{??????struct?myuvc_buffer?*buffer?=?vma->vm_private_data;??????buffer->vma_use_count++;??}????static?void?myuvc_vm_close(struct?vm_area_struct?*vma)??{??????struct?myuvc_buffer?*buffer?=?vma->vm_private_data;??????buffer->vma_use_count--;??}????static?struct?vm_operations_struct?myuvc_vm_ops?=?{??????.open???????=?myuvc_vm_open,??????.close??????=?myuvc_vm_close,??};??????????static?int?myuvc_mmap(struct?file?*file,?struct?vm_area_struct?*vma)??{??????struct?myuvc_buffer?*buffer;??????struct?page?*page;??????unsigned?long?addr,?start,?size;??????unsigned?int?i;??????int?ret?=?0;????????start?=?vma->vm_start;??????size?=?vma->vm_end?-?vma->vm_start;????????????????for?(i?=?0;?i?<?myuvc_queue.count;?++i)?{??????????buffer?=?&myuvc_queue.buffer[i];??????????if?((buffer->buf.m.offset?>>?PAGE_SHIFT)?==?vma->vm_pgoff)??????????????break;??????}????????if?(i?==?myuvc_queue.count?||?size?!=?myuvc_queue.buf_size)?{??????????ret?=?-EINVAL;??????????goto?done;??????}?????????????????vma->vm_flags?|=?VM_IO;??????????????addr?=?(unsigned?long)myuvc_queue.mem?+?buffer->buf.m.offset;??????while?(size?>?0)?{??????????page?=?vmalloc_to_page((void?*)addr);??????????????????????if?((ret?=?vm_insert_page(vma,?start,?page))?<?0)??????????????goto?done;????????????start?+=?PAGE_SIZE;??????????addr?+=?PAGE_SIZE;??????????size?-=?PAGE_SIZE;??????}????????vma->vm_ops?=?&myuvc_vm_ops;??????vma->vm_private_data?=?buffer;??????myuvc_vm_open(vma);????done:??????return?ret;??}????????static?unsigned?int?myuvc_poll(struct?file?*file,?struct?poll_table_struct?*wait)??{??????struct?myuvc_buffer?*buf;??????unsigned?int?mask?=?0;????????????????????????????if?(list_empty(&myuvc_queue.mainqueue))?{??????????mask?|=?POLLERR;??????????goto?done;??????}????????????buf?=?list_first_entry(&myuvc_queue.mainqueue,?struct?myuvc_buffer,?stream);????????poll_wait(file,?&buf->wait,?wait);??????if?(buf->state?==?VIDEOBUF_DONE?||??????????buf->state?==?VIDEOBUF_ERROR)??????????mask?|=?POLLIN?|?POLLRDNORM;????????done:??????return?mask;??}??????static?int?myuvc_vidioc_streamoff(struct?file?*file,?void?*priv,?enum?v4l2_buf_type?t);??static?int?myuvc_close(struct?file?*file)??{??????myuvc_vidioc_streamoff(NULL,?NULL,?0);??????return?0;??}????static?const?struct?v4l2_file_operations?myuvc_fops?=?{??????.owner??????=?THIS_MODULE,??????.open???????=?myuvc_open,??????.release????=?myuvc_close,??????.mmap???????=?myuvc_mmap,??????.ioctl??????=?video_ioctl2,???????.poll???????=?myuvc_poll,??};????static?void?myuvc_release(struct?video_device?*vdev)??{??}??????static?int?myuvc_probe(struct?usb_interface?*intf,???????????????const?struct?usb_device_id?*id)??{??????static?int?cnt?=?0;??????struct?usb_device?*dev?=?interface_to_usbdev(intf);??????int?ret;????????myuvc_udev?=?dev;????????printk("myuvc_probe?:?cnt?=?%d\n",?cnt++);????????if?(cnt?==?1)??????{??????????myuvc_control_intf?=?intf->cur_altsetting->desc.bInterfaceNumber;??????}??????else?if?(cnt?==?2)??????{??????????myuvc_streaming_intf?=?intf->cur_altsetting->desc.bInterfaceNumber;??????}????????if?(cnt?==?2)??????{????????????????????myuvc_vdev?=?video_device_alloc();????????????????????????????????myuvc_vdev->release?=?myuvc_release;??????????????????????????????myuvc_vdev->fops????=?&myuvc_fops;??????????????????????????????myuvc_vdev->ioctl_ops?=?&myuvc_ioctl_ops;??????????????????????video_register_device(myuvc_vdev,?VFL_TYPE_GRABBER,?-1);????????????????????????????????ret?=?myuvc_try_streaming_params(&myuvc_params);??????????printk("myuvc_try_streaming_params?ret?=?%d\n",?ret);??????????????????????ret?=?myuvc_get_streaming_params(&myuvc_params);??????????printk("myuvc_get_streaming_params?ret?=?%d\n",?ret);??????????????????????ret?=?myuvc_set_streaming_params(&myuvc_params);??????????printk("myuvc_set_streaming_params?ret?=?%d\n",?ret);????????????????????myuvc_print_streaming_params(&myuvc_params);????????}??????????????????return?0;??}????static?void?myuvc_disconnect(struct?usb_interface?*intf)??{??????static?int?cnt?=?0;??????printk("myuvc_disconnect?:?cnt?=?%d\n",?cnt++);????????if?(cnt?==?2)??????{??????????video_unregister_device(myuvc_vdev);??????????video_device_release(myuvc_vdev);??????}????????}????static?struct?usb_device_id?myuvc_ids[]?=?{????????????{?USB_INTERFACE_INFO(USB_CLASS_VIDEO,?1,?0)?},????????{?USB_INTERFACE_INFO(USB_CLASS_VIDEO,?2,?0)?},????????{}??};????????static?struct?usb_driver?myuvc_driver?=?{??????.name???????=?"myuvc",??????.probe??????=?myuvc_probe,??????.disconnect?=?myuvc_disconnect,??????.id_table???=?myuvc_ids,??};????static?int?myuvc_init(void)??{????????????usb_register(&myuvc_driver);??????return?0;??}????static?void?myuvc_exit(void)??{??????usb_deregister(&myuvc_driver);??}????module_init(myuvc_init);??module_exit(myuvc_exit);????MODULE_LICENSE("GPL");??????????????????</media></media></media></asm></asm></linux></linux></linux></linux></linux></linux></linux></linux>?
總結(jié)
以上是生活随笔為你收集整理的自己写的uvc驱动支持IP2977/ip2970的全部內(nèi)容，希望文章能夠幫你解決所遇到的問題。
如果覺得生活随笔網(wǎng)站內(nèi)容還不錯(cuò)，歡迎將生活随笔推薦給好友。
