gspca.c 54 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244
  1. /*
  2. * Main USB camera driver
  3. *
  4. * Copyright (C) 2008-2009 Jean-Francois Moine (http://moinejf.free.fr)
  5. *
  6. * This program is free software; you can redistribute it and/or modify it
  7. * under the terms of the GNU General Public License as published by the
  8. * Free Software Foundation; either version 2 of the License, or (at your
  9. * option) any later version.
  10. *
  11. * This program is distributed in the hope that it will be useful, but
  12. * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY
  13. * or FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
  14. * for more details.
  15. *
  16. * You should have received a copy of the GNU General Public License
  17. * along with this program; if not, write to the Free Software Foundation,
  18. * Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  19. */
  20. #define MODULE_NAME "gspca"
  21. #include <linux/init.h>
  22. #include <linux/version.h>
  23. #include <linux/fs.h>
  24. #include <linux/vmalloc.h>
  25. #include <linux/sched.h>
  26. #include <linux/slab.h>
  27. #include <linux/mm.h>
  28. #include <linux/string.h>
  29. #include <linux/pagemap.h>
  30. #include <linux/io.h>
  31. #include <asm/page.h>
  32. #include <linux/uaccess.h>
  33. #include <linux/jiffies.h>
  34. #include <media/v4l2-ioctl.h>
  35. #include "gspca.h"
  36. /* global values */
  37. #define DEF_NURBS 3 /* default number of URBs */
  38. #if DEF_NURBS > MAX_NURBS
  39. #error "DEF_NURBS too big"
  40. #endif
  41. MODULE_AUTHOR("Jean-Francois Moine <http://moinejf.free.fr>");
  42. MODULE_DESCRIPTION("GSPCA USB Camera Driver");
  43. MODULE_LICENSE("GPL");
  44. #define DRIVER_VERSION_NUMBER KERNEL_VERSION(2, 7, 0)
  45. #ifdef GSPCA_DEBUG
  46. int gspca_debug = D_ERR | D_PROBE;
  47. EXPORT_SYMBOL(gspca_debug);
  48. static void PDEBUG_MODE(char *txt, __u32 pixfmt, int w, int h)
  49. {
  50. if ((pixfmt >> 24) >= '0' && (pixfmt >> 24) <= 'z') {
  51. PDEBUG(D_CONF|D_STREAM, "%s %c%c%c%c %dx%d",
  52. txt,
  53. pixfmt & 0xff,
  54. (pixfmt >> 8) & 0xff,
  55. (pixfmt >> 16) & 0xff,
  56. pixfmt >> 24,
  57. w, h);
  58. } else {
  59. PDEBUG(D_CONF|D_STREAM, "%s 0x%08x %dx%d",
  60. txt,
  61. pixfmt,
  62. w, h);
  63. }
  64. }
  65. #else
  66. #define PDEBUG_MODE(txt, pixfmt, w, h)
  67. #endif
  68. /* specific memory types - !! should different from V4L2_MEMORY_xxx */
  69. #define GSPCA_MEMORY_NO 0 /* V4L2_MEMORY_xxx starts from 1 */
  70. #define GSPCA_MEMORY_READ 7
  71. #define BUF_ALL_FLAGS (V4L2_BUF_FLAG_QUEUED | V4L2_BUF_FLAG_DONE)
  72. /*
  73. * VMA operations.
  74. */
  75. static void gspca_vm_open(struct vm_area_struct *vma)
  76. {
  77. struct gspca_frame *frame = vma->vm_private_data;
  78. frame->vma_use_count++;
  79. frame->v4l2_buf.flags |= V4L2_BUF_FLAG_MAPPED;
  80. }
  81. static void gspca_vm_close(struct vm_area_struct *vma)
  82. {
  83. struct gspca_frame *frame = vma->vm_private_data;
  84. if (--frame->vma_use_count <= 0)
  85. frame->v4l2_buf.flags &= ~V4L2_BUF_FLAG_MAPPED;
  86. }
  87. static const struct vm_operations_struct gspca_vm_ops = {
  88. .open = gspca_vm_open,
  89. .close = gspca_vm_close,
  90. };
  91. /* get the current input frame buffer */
  92. struct gspca_frame *gspca_get_i_frame(struct gspca_dev *gspca_dev)
  93. {
  94. struct gspca_frame *frame;
  95. int i;
  96. i = gspca_dev->fr_i;
  97. i = gspca_dev->fr_queue[i];
  98. frame = &gspca_dev->frame[i];
  99. if ((frame->v4l2_buf.flags & BUF_ALL_FLAGS)
  100. != V4L2_BUF_FLAG_QUEUED)
  101. return NULL;
  102. return frame;
  103. }
  104. EXPORT_SYMBOL(gspca_get_i_frame);
  105. /*
  106. * fill a video frame from an URB and resubmit
  107. */
  108. static void fill_frame(struct gspca_dev *gspca_dev,
  109. struct urb *urb)
  110. {
  111. struct gspca_frame *frame;
  112. u8 *data; /* address of data in the iso message */
  113. int i, len, st;
  114. cam_pkt_op pkt_scan;
  115. if (urb->status != 0) {
  116. if (urb->status == -ESHUTDOWN)
  117. return; /* disconnection */
  118. #ifdef CONFIG_PM
  119. if (!gspca_dev->frozen)
  120. #endif
  121. PDEBUG(D_ERR|D_PACK, "urb status: %d", urb->status);
  122. return;
  123. }
  124. pkt_scan = gspca_dev->sd_desc->pkt_scan;
  125. for (i = 0; i < urb->number_of_packets; i++) {
  126. /* check the availability of the frame buffer */
  127. frame = gspca_get_i_frame(gspca_dev);
  128. if (!frame) {
  129. gspca_dev->last_packet_type = DISCARD_PACKET;
  130. break;
  131. }
  132. /* check the packet status and length */
  133. len = urb->iso_frame_desc[i].actual_length;
  134. if (len == 0) {
  135. if (gspca_dev->empty_packet == 0)
  136. gspca_dev->empty_packet = 1;
  137. continue;
  138. }
  139. st = urb->iso_frame_desc[i].status;
  140. if (st) {
  141. PDEBUG(D_ERR,
  142. "ISOC data error: [%d] len=%d, status=%d",
  143. i, len, st);
  144. gspca_dev->last_packet_type = DISCARD_PACKET;
  145. continue;
  146. }
  147. /* let the packet be analyzed by the subdriver */
  148. PDEBUG(D_PACK, "packet [%d] o:%d l:%d",
  149. i, urb->iso_frame_desc[i].offset, len);
  150. data = (u8 *) urb->transfer_buffer
  151. + urb->iso_frame_desc[i].offset;
  152. pkt_scan(gspca_dev, frame, data, len);
  153. }
  154. /* resubmit the URB */
  155. st = usb_submit_urb(urb, GFP_ATOMIC);
  156. if (st < 0)
  157. PDEBUG(D_ERR|D_PACK, "usb_submit_urb() ret %d", st);
  158. }
  159. /*
  160. * ISOC message interrupt from the USB device
  161. *
  162. * Analyse each packet and call the subdriver for copy to the frame buffer.
  163. */
  164. static void isoc_irq(struct urb *urb)
  165. {
  166. struct gspca_dev *gspca_dev = (struct gspca_dev *) urb->context;
  167. PDEBUG(D_PACK, "isoc irq");
  168. if (!gspca_dev->streaming)
  169. return;
  170. fill_frame(gspca_dev, urb);
  171. }
  172. /*
  173. * bulk message interrupt from the USB device
  174. */
  175. static void bulk_irq(struct urb *urb)
  176. {
  177. struct gspca_dev *gspca_dev = (struct gspca_dev *) urb->context;
  178. struct gspca_frame *frame;
  179. int st;
  180. PDEBUG(D_PACK, "bulk irq");
  181. if (!gspca_dev->streaming)
  182. return;
  183. switch (urb->status) {
  184. case 0:
  185. break;
  186. case -ESHUTDOWN:
  187. return; /* disconnection */
  188. case -ECONNRESET:
  189. urb->status = 0;
  190. break;
  191. default:
  192. #ifdef CONFIG_PM
  193. if (!gspca_dev->frozen)
  194. #endif
  195. PDEBUG(D_ERR|D_PACK, "urb status: %d", urb->status);
  196. return;
  197. }
  198. /* check the availability of the frame buffer */
  199. frame = gspca_get_i_frame(gspca_dev);
  200. if (!frame) {
  201. gspca_dev->last_packet_type = DISCARD_PACKET;
  202. } else {
  203. PDEBUG(D_PACK, "packet l:%d", urb->actual_length);
  204. gspca_dev->sd_desc->pkt_scan(gspca_dev,
  205. frame,
  206. urb->transfer_buffer,
  207. urb->actual_length);
  208. }
  209. /* resubmit the URB */
  210. if (gspca_dev->cam.bulk_nurbs != 0) {
  211. st = usb_submit_urb(urb, GFP_ATOMIC);
  212. if (st < 0)
  213. PDEBUG(D_ERR|D_PACK, "usb_submit_urb() ret %d", st);
  214. }
  215. }
  216. /*
  217. * add data to the current frame
  218. *
  219. * This function is called by the subdrivers at interrupt level.
  220. *
  221. * To build a frame, these ones must add
  222. * - one FIRST_PACKET
  223. * - 0 or many INTER_PACKETs
  224. * - one LAST_PACKET
  225. * DISCARD_PACKET invalidates the whole frame.
  226. * On LAST_PACKET, a new frame is returned.
  227. */
  228. struct gspca_frame *gspca_frame_add(struct gspca_dev *gspca_dev,
  229. enum gspca_packet_type packet_type,
  230. struct gspca_frame *frame,
  231. const __u8 *data,
  232. int len)
  233. {
  234. int i, j;
  235. PDEBUG(D_PACK, "add t:%d l:%d", packet_type, len);
  236. /* when start of a new frame, if the current frame buffer
  237. * is not queued, discard the whole frame */
  238. if (packet_type == FIRST_PACKET) {
  239. if ((frame->v4l2_buf.flags & BUF_ALL_FLAGS)
  240. != V4L2_BUF_FLAG_QUEUED) {
  241. gspca_dev->last_packet_type = DISCARD_PACKET;
  242. return frame;
  243. }
  244. frame->data_end = frame->data;
  245. jiffies_to_timeval(get_jiffies_64(),
  246. &frame->v4l2_buf.timestamp);
  247. frame->v4l2_buf.sequence = ++gspca_dev->sequence;
  248. } else if (gspca_dev->last_packet_type == DISCARD_PACKET) {
  249. if (packet_type == LAST_PACKET)
  250. gspca_dev->last_packet_type = packet_type;
  251. return frame;
  252. }
  253. /* append the packet to the frame buffer */
  254. if (len > 0) {
  255. if (frame->data_end - frame->data + len
  256. > frame->v4l2_buf.length) {
  257. PDEBUG(D_ERR|D_PACK, "frame overflow %zd > %d",
  258. frame->data_end - frame->data + len,
  259. frame->v4l2_buf.length);
  260. packet_type = DISCARD_PACKET;
  261. } else {
  262. memcpy(frame->data_end, data, len);
  263. frame->data_end += len;
  264. }
  265. }
  266. gspca_dev->last_packet_type = packet_type;
  267. /* if last packet, wake up the application and advance in the queue */
  268. if (packet_type == LAST_PACKET) {
  269. frame->v4l2_buf.bytesused = frame->data_end - frame->data;
  270. frame->v4l2_buf.flags &= ~V4L2_BUF_FLAG_QUEUED;
  271. frame->v4l2_buf.flags |= V4L2_BUF_FLAG_DONE;
  272. wake_up_interruptible(&gspca_dev->wq); /* event = new frame */
  273. i = (gspca_dev->fr_i + 1) % gspca_dev->nframes;
  274. gspca_dev->fr_i = i;
  275. PDEBUG(D_FRAM, "frame complete len:%d q:%d i:%d o:%d",
  276. frame->v4l2_buf.bytesused,
  277. gspca_dev->fr_q,
  278. i,
  279. gspca_dev->fr_o);
  280. j = gspca_dev->fr_queue[i];
  281. frame = &gspca_dev->frame[j];
  282. }
  283. return frame;
  284. }
  285. EXPORT_SYMBOL(gspca_frame_add);
  286. static int gspca_is_compressed(__u32 format)
  287. {
  288. switch (format) {
  289. case V4L2_PIX_FMT_MJPEG:
  290. case V4L2_PIX_FMT_JPEG:
  291. case V4L2_PIX_FMT_SPCA561:
  292. case V4L2_PIX_FMT_PAC207:
  293. case V4L2_PIX_FMT_MR97310A:
  294. return 1;
  295. }
  296. return 0;
  297. }
  298. static void *rvmalloc(unsigned long size)
  299. {
  300. void *mem;
  301. unsigned long adr;
  302. mem = vmalloc_32(size);
  303. if (mem != NULL) {
  304. adr = (unsigned long) mem;
  305. while ((long) size > 0) {
  306. SetPageReserved(vmalloc_to_page((void *) adr));
  307. adr += PAGE_SIZE;
  308. size -= PAGE_SIZE;
  309. }
  310. }
  311. return mem;
  312. }
  313. static void rvfree(void *mem, long size)
  314. {
  315. unsigned long adr;
  316. adr = (unsigned long) mem;
  317. while (size > 0) {
  318. ClearPageReserved(vmalloc_to_page((void *) adr));
  319. adr += PAGE_SIZE;
  320. size -= PAGE_SIZE;
  321. }
  322. vfree(mem);
  323. }
  324. static int frame_alloc(struct gspca_dev *gspca_dev,
  325. unsigned int count)
  326. {
  327. struct gspca_frame *frame;
  328. unsigned int frsz;
  329. int i;
  330. i = gspca_dev->curr_mode;
  331. frsz = gspca_dev->cam.cam_mode[i].sizeimage;
  332. PDEBUG(D_STREAM, "frame alloc frsz: %d", frsz);
  333. frsz = PAGE_ALIGN(frsz);
  334. gspca_dev->frsz = frsz;
  335. if (count > GSPCA_MAX_FRAMES)
  336. count = GSPCA_MAX_FRAMES;
  337. gspca_dev->frbuf = rvmalloc(frsz * count);
  338. if (!gspca_dev->frbuf) {
  339. err("frame alloc failed");
  340. return -ENOMEM;
  341. }
  342. gspca_dev->nframes = count;
  343. for (i = 0; i < count; i++) {
  344. frame = &gspca_dev->frame[i];
  345. frame->v4l2_buf.index = i;
  346. frame->v4l2_buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
  347. frame->v4l2_buf.flags = 0;
  348. frame->v4l2_buf.field = V4L2_FIELD_NONE;
  349. frame->v4l2_buf.length = frsz;
  350. frame->v4l2_buf.memory = gspca_dev->memory;
  351. frame->v4l2_buf.sequence = 0;
  352. frame->data = frame->data_end =
  353. gspca_dev->frbuf + i * frsz;
  354. frame->v4l2_buf.m.offset = i * frsz;
  355. }
  356. gspca_dev->fr_i = gspca_dev->fr_o = gspca_dev->fr_q = 0;
  357. gspca_dev->last_packet_type = DISCARD_PACKET;
  358. gspca_dev->sequence = 0;
  359. return 0;
  360. }
  361. static void frame_free(struct gspca_dev *gspca_dev)
  362. {
  363. int i;
  364. PDEBUG(D_STREAM, "frame free");
  365. if (gspca_dev->frbuf != NULL) {
  366. rvfree(gspca_dev->frbuf,
  367. gspca_dev->nframes * gspca_dev->frsz);
  368. gspca_dev->frbuf = NULL;
  369. for (i = 0; i < gspca_dev->nframes; i++)
  370. gspca_dev->frame[i].data = NULL;
  371. }
  372. gspca_dev->nframes = 0;
  373. }
  374. static void destroy_urbs(struct gspca_dev *gspca_dev)
  375. {
  376. struct urb *urb;
  377. unsigned int i;
  378. PDEBUG(D_STREAM, "kill transfer");
  379. for (i = 0; i < MAX_NURBS; i++) {
  380. urb = gspca_dev->urb[i];
  381. if (urb == NULL)
  382. break;
  383. gspca_dev->urb[i] = NULL;
  384. usb_kill_urb(urb);
  385. if (urb->transfer_buffer != NULL)
  386. usb_buffer_free(gspca_dev->dev,
  387. urb->transfer_buffer_length,
  388. urb->transfer_buffer,
  389. urb->transfer_dma);
  390. usb_free_urb(urb);
  391. }
  392. }
  393. /*
  394. * look for an input transfer endpoint in an alternate setting
  395. */
  396. static struct usb_host_endpoint *alt_xfer(struct usb_host_interface *alt,
  397. int xfer)
  398. {
  399. struct usb_host_endpoint *ep;
  400. int i, attr;
  401. for (i = 0; i < alt->desc.bNumEndpoints; i++) {
  402. ep = &alt->endpoint[i];
  403. attr = ep->desc.bmAttributes & USB_ENDPOINT_XFERTYPE_MASK;
  404. if (attr == xfer
  405. && ep->desc.wMaxPacketSize != 0)
  406. return ep;
  407. }
  408. return NULL;
  409. }
  410. /*
  411. * look for an input (isoc or bulk) endpoint
  412. *
  413. * The endpoint is defined by the subdriver.
  414. * Use only the first isoc (some Zoran - 0x0572:0x0001 - have two such ep).
  415. * This routine may be called many times when the bandwidth is too small
  416. * (the bandwidth is checked on urb submit).
  417. */
  418. static struct usb_host_endpoint *get_ep(struct gspca_dev *gspca_dev)
  419. {
  420. struct usb_interface *intf;
  421. struct usb_host_endpoint *ep;
  422. int xfer, i, ret;
  423. intf = usb_ifnum_to_if(gspca_dev->dev, gspca_dev->iface);
  424. ep = NULL;
  425. xfer = gspca_dev->cam.bulk ? USB_ENDPOINT_XFER_BULK
  426. : USB_ENDPOINT_XFER_ISOC;
  427. i = gspca_dev->alt; /* previous alt setting */
  428. while (--i >= 0) {
  429. ep = alt_xfer(&intf->altsetting[i], xfer);
  430. if (ep)
  431. break;
  432. }
  433. if (ep == NULL) {
  434. err("no transfer endpoint found");
  435. return NULL;
  436. }
  437. PDEBUG(D_STREAM, "use alt %d ep 0x%02x",
  438. i, ep->desc.bEndpointAddress);
  439. gspca_dev->alt = i; /* memorize the current alt setting */
  440. if (gspca_dev->nbalt > 1) {
  441. ret = usb_set_interface(gspca_dev->dev, gspca_dev->iface, i);
  442. if (ret < 0) {
  443. err("set alt %d err %d", i, ret);
  444. return NULL;
  445. }
  446. }
  447. return ep;
  448. }
  449. /*
  450. * create the URBs for image transfer
  451. */
  452. static int create_urbs(struct gspca_dev *gspca_dev,
  453. struct usb_host_endpoint *ep)
  454. {
  455. struct urb *urb;
  456. int n, nurbs, i, psize, npkt, bsize;
  457. /* calculate the packet size and the number of packets */
  458. psize = le16_to_cpu(ep->desc.wMaxPacketSize);
  459. if (!gspca_dev->cam.bulk) { /* isoc */
  460. /* See paragraph 5.9 / table 5-11 of the usb 2.0 spec. */
  461. if (gspca_dev->pkt_size == 0)
  462. psize = (psize & 0x07ff) * (1 + ((psize >> 11) & 3));
  463. else
  464. psize = gspca_dev->pkt_size;
  465. npkt = gspca_dev->cam.npkt;
  466. if (npkt == 0)
  467. npkt = 32; /* default value */
  468. bsize = psize * npkt;
  469. PDEBUG(D_STREAM,
  470. "isoc %d pkts size %d = bsize:%d",
  471. npkt, psize, bsize);
  472. nurbs = DEF_NURBS;
  473. } else { /* bulk */
  474. npkt = 0;
  475. bsize = gspca_dev->cam.bulk_size;
  476. if (bsize == 0)
  477. bsize = psize;
  478. PDEBUG(D_STREAM, "bulk bsize:%d", bsize);
  479. if (gspca_dev->cam.bulk_nurbs != 0)
  480. nurbs = gspca_dev->cam.bulk_nurbs;
  481. else
  482. nurbs = 1;
  483. }
  484. gspca_dev->nurbs = nurbs;
  485. for (n = 0; n < nurbs; n++) {
  486. urb = usb_alloc_urb(npkt, GFP_KERNEL);
  487. if (!urb) {
  488. err("usb_alloc_urb failed");
  489. destroy_urbs(gspca_dev);
  490. return -ENOMEM;
  491. }
  492. urb->transfer_buffer = usb_buffer_alloc(gspca_dev->dev,
  493. bsize,
  494. GFP_KERNEL,
  495. &urb->transfer_dma);
  496. if (urb->transfer_buffer == NULL) {
  497. usb_free_urb(urb);
  498. err("usb_buffer_urb failed");
  499. destroy_urbs(gspca_dev);
  500. return -ENOMEM;
  501. }
  502. gspca_dev->urb[n] = urb;
  503. urb->dev = gspca_dev->dev;
  504. urb->context = gspca_dev;
  505. urb->transfer_buffer_length = bsize;
  506. if (npkt != 0) { /* ISOC */
  507. urb->pipe = usb_rcvisocpipe(gspca_dev->dev,
  508. ep->desc.bEndpointAddress);
  509. urb->transfer_flags = URB_ISO_ASAP
  510. | URB_NO_TRANSFER_DMA_MAP;
  511. urb->interval = ep->desc.bInterval;
  512. urb->complete = isoc_irq;
  513. urb->number_of_packets = npkt;
  514. for (i = 0; i < npkt; i++) {
  515. urb->iso_frame_desc[i].length = psize;
  516. urb->iso_frame_desc[i].offset = psize * i;
  517. }
  518. } else { /* bulk */
  519. urb->pipe = usb_rcvbulkpipe(gspca_dev->dev,
  520. ep->desc.bEndpointAddress),
  521. urb->transfer_flags = URB_NO_TRANSFER_DMA_MAP;
  522. urb->complete = bulk_irq;
  523. }
  524. }
  525. return 0;
  526. }
  527. /*
  528. * start the USB transfer
  529. */
  530. static int gspca_init_transfer(struct gspca_dev *gspca_dev)
  531. {
  532. struct usb_host_endpoint *ep;
  533. int n, ret;
  534. if (mutex_lock_interruptible(&gspca_dev->usb_lock))
  535. return -ERESTARTSYS;
  536. if (!gspca_dev->present) {
  537. ret = -ENODEV;
  538. goto out;
  539. }
  540. /* set the higher alternate setting and
  541. * loop until urb submit succeeds */
  542. gspca_dev->alt = gspca_dev->nbalt;
  543. if (gspca_dev->sd_desc->isoc_init) {
  544. ret = gspca_dev->sd_desc->isoc_init(gspca_dev);
  545. if (ret < 0)
  546. goto out;
  547. }
  548. ep = get_ep(gspca_dev);
  549. if (ep == NULL) {
  550. ret = -EIO;
  551. goto out;
  552. }
  553. for (;;) {
  554. PDEBUG(D_STREAM, "init transfer alt %d", gspca_dev->alt);
  555. ret = create_urbs(gspca_dev, ep);
  556. if (ret < 0)
  557. goto out;
  558. /* clear the bulk endpoint */
  559. if (gspca_dev->cam.bulk)
  560. usb_clear_halt(gspca_dev->dev,
  561. gspca_dev->urb[0]->pipe);
  562. /* start the cam */
  563. ret = gspca_dev->sd_desc->start(gspca_dev);
  564. if (ret < 0) {
  565. destroy_urbs(gspca_dev);
  566. goto out;
  567. }
  568. gspca_dev->streaming = 1;
  569. /* some bulk transfers are started by the subdriver */
  570. if (gspca_dev->cam.bulk && gspca_dev->cam.bulk_nurbs == 0)
  571. break;
  572. /* submit the URBs */
  573. for (n = 0; n < gspca_dev->nurbs; n++) {
  574. ret = usb_submit_urb(gspca_dev->urb[n], GFP_KERNEL);
  575. if (ret < 0)
  576. break;
  577. }
  578. if (ret >= 0)
  579. break;
  580. PDEBUG(D_ERR|D_STREAM,
  581. "usb_submit_urb alt %d err %d", gspca_dev->alt, ret);
  582. gspca_dev->streaming = 0;
  583. destroy_urbs(gspca_dev);
  584. if (ret != -ENOSPC)
  585. goto out;
  586. /* the bandwidth is not wide enough
  587. * negociate or try a lower alternate setting */
  588. msleep(20); /* wait for kill complete */
  589. if (gspca_dev->sd_desc->isoc_nego) {
  590. ret = gspca_dev->sd_desc->isoc_nego(gspca_dev);
  591. if (ret < 0)
  592. goto out;
  593. } else {
  594. ep = get_ep(gspca_dev);
  595. if (ep == NULL) {
  596. ret = -EIO;
  597. goto out;
  598. }
  599. }
  600. }
  601. out:
  602. mutex_unlock(&gspca_dev->usb_lock);
  603. return ret;
  604. }
  605. static int gspca_set_alt0(struct gspca_dev *gspca_dev)
  606. {
  607. int ret;
  608. if (gspca_dev->alt == 0)
  609. return 0;
  610. ret = usb_set_interface(gspca_dev->dev, gspca_dev->iface, 0);
  611. if (ret < 0)
  612. PDEBUG(D_ERR|D_STREAM, "set alt 0 err %d", ret);
  613. return ret;
  614. }
  615. /* Note: both the queue and the usb locks should be held when calling this */
  616. static void gspca_stream_off(struct gspca_dev *gspca_dev)
  617. {
  618. gspca_dev->streaming = 0;
  619. if (gspca_dev->present) {
  620. if (gspca_dev->sd_desc->stopN)
  621. gspca_dev->sd_desc->stopN(gspca_dev);
  622. destroy_urbs(gspca_dev);
  623. gspca_set_alt0(gspca_dev);
  624. }
  625. /* always call stop0 to free the subdriver's resources */
  626. if (gspca_dev->sd_desc->stop0)
  627. gspca_dev->sd_desc->stop0(gspca_dev);
  628. PDEBUG(D_STREAM, "stream off OK");
  629. }
  630. static void gspca_set_default_mode(struct gspca_dev *gspca_dev)
  631. {
  632. int i;
  633. i = gspca_dev->cam.nmodes - 1; /* take the highest mode */
  634. gspca_dev->curr_mode = i;
  635. gspca_dev->width = gspca_dev->cam.cam_mode[i].width;
  636. gspca_dev->height = gspca_dev->cam.cam_mode[i].height;
  637. gspca_dev->pixfmt = gspca_dev->cam.cam_mode[i].pixelformat;
  638. }
  639. static int wxh_to_mode(struct gspca_dev *gspca_dev,
  640. int width, int height)
  641. {
  642. int i;
  643. for (i = gspca_dev->cam.nmodes; --i > 0; ) {
  644. if (width >= gspca_dev->cam.cam_mode[i].width
  645. && height >= gspca_dev->cam.cam_mode[i].height)
  646. break;
  647. }
  648. return i;
  649. }
  650. /*
  651. * search a mode with the right pixel format
  652. */
  653. static int gspca_get_mode(struct gspca_dev *gspca_dev,
  654. int mode,
  655. int pixfmt)
  656. {
  657. int modeU, modeD;
  658. modeU = modeD = mode;
  659. while ((modeU < gspca_dev->cam.nmodes) || modeD >= 0) {
  660. if (--modeD >= 0) {
  661. if (gspca_dev->cam.cam_mode[modeD].pixelformat
  662. == pixfmt)
  663. return modeD;
  664. }
  665. if (++modeU < gspca_dev->cam.nmodes) {
  666. if (gspca_dev->cam.cam_mode[modeU].pixelformat
  667. == pixfmt)
  668. return modeU;
  669. }
  670. }
  671. return -EINVAL;
  672. }
  673. #ifdef CONFIG_VIDEO_ADV_DEBUG
  674. static int vidioc_g_register(struct file *file, void *priv,
  675. struct v4l2_dbg_register *reg)
  676. {
  677. int ret;
  678. struct gspca_dev *gspca_dev = priv;
  679. if (!gspca_dev->sd_desc->get_chip_ident)
  680. return -EINVAL;
  681. if (!gspca_dev->sd_desc->get_register)
  682. return -EINVAL;
  683. if (mutex_lock_interruptible(&gspca_dev->usb_lock))
  684. return -ERESTARTSYS;
  685. if (gspca_dev->present)
  686. ret = gspca_dev->sd_desc->get_register(gspca_dev, reg);
  687. else
  688. ret = -ENODEV;
  689. mutex_unlock(&gspca_dev->usb_lock);
  690. return ret;
  691. }
  692. static int vidioc_s_register(struct file *file, void *priv,
  693. struct v4l2_dbg_register *reg)
  694. {
  695. int ret;
  696. struct gspca_dev *gspca_dev = priv;
  697. if (!gspca_dev->sd_desc->get_chip_ident)
  698. return -EINVAL;
  699. if (!gspca_dev->sd_desc->set_register)
  700. return -EINVAL;
  701. if (mutex_lock_interruptible(&gspca_dev->usb_lock))
  702. return -ERESTARTSYS;
  703. if (gspca_dev->present)
  704. ret = gspca_dev->sd_desc->set_register(gspca_dev, reg);
  705. else
  706. ret = -ENODEV;
  707. mutex_unlock(&gspca_dev->usb_lock);
  708. return ret;
  709. }
  710. #endif
  711. static int vidioc_g_chip_ident(struct file *file, void *priv,
  712. struct v4l2_dbg_chip_ident *chip)
  713. {
  714. int ret;
  715. struct gspca_dev *gspca_dev = priv;
  716. if (!gspca_dev->sd_desc->get_chip_ident)
  717. return -EINVAL;
  718. if (mutex_lock_interruptible(&gspca_dev->usb_lock))
  719. return -ERESTARTSYS;
  720. if (gspca_dev->present)
  721. ret = gspca_dev->sd_desc->get_chip_ident(gspca_dev, chip);
  722. else
  723. ret = -ENODEV;
  724. mutex_unlock(&gspca_dev->usb_lock);
  725. return ret;
  726. }
  727. static int vidioc_enum_fmt_vid_cap(struct file *file, void *priv,
  728. struct v4l2_fmtdesc *fmtdesc)
  729. {
  730. struct gspca_dev *gspca_dev = priv;
  731. int i, j, index;
  732. __u32 fmt_tb[8];
  733. /* give an index to each format */
  734. index = 0;
  735. j = 0;
  736. for (i = gspca_dev->cam.nmodes; --i >= 0; ) {
  737. fmt_tb[index] = gspca_dev->cam.cam_mode[i].pixelformat;
  738. j = 0;
  739. for (;;) {
  740. if (fmt_tb[j] == fmt_tb[index])
  741. break;
  742. j++;
  743. }
  744. if (j == index) {
  745. if (fmtdesc->index == index)
  746. break; /* new format */
  747. index++;
  748. if (index >= ARRAY_SIZE(fmt_tb))
  749. return -EINVAL;
  750. }
  751. }
  752. if (i < 0)
  753. return -EINVAL; /* no more format */
  754. fmtdesc->pixelformat = fmt_tb[index];
  755. if (gspca_is_compressed(fmt_tb[index]))
  756. fmtdesc->flags = V4L2_FMT_FLAG_COMPRESSED;
  757. fmtdesc->description[0] = fmtdesc->pixelformat & 0xff;
  758. fmtdesc->description[1] = (fmtdesc->pixelformat >> 8) & 0xff;
  759. fmtdesc->description[2] = (fmtdesc->pixelformat >> 16) & 0xff;
  760. fmtdesc->description[3] = fmtdesc->pixelformat >> 24;
  761. fmtdesc->description[4] = '\0';
  762. return 0;
  763. }
  764. static int vidioc_g_fmt_vid_cap(struct file *file, void *priv,
  765. struct v4l2_format *fmt)
  766. {
  767. struct gspca_dev *gspca_dev = priv;
  768. int mode;
  769. mode = gspca_dev->curr_mode;
  770. memcpy(&fmt->fmt.pix, &gspca_dev->cam.cam_mode[mode],
  771. sizeof fmt->fmt.pix);
  772. return 0;
  773. }
  774. static int try_fmt_vid_cap(struct gspca_dev *gspca_dev,
  775. struct v4l2_format *fmt)
  776. {
  777. int w, h, mode, mode2;
  778. w = fmt->fmt.pix.width;
  779. h = fmt->fmt.pix.height;
  780. #ifdef GSPCA_DEBUG
  781. if (gspca_debug & D_CONF)
  782. PDEBUG_MODE("try fmt cap", fmt->fmt.pix.pixelformat, w, h);
  783. #endif
  784. /* search the closest mode for width and height */
  785. mode = wxh_to_mode(gspca_dev, w, h);
  786. /* OK if right palette */
  787. if (gspca_dev->cam.cam_mode[mode].pixelformat
  788. != fmt->fmt.pix.pixelformat) {
  789. /* else, search the closest mode with the same pixel format */
  790. mode2 = gspca_get_mode(gspca_dev, mode,
  791. fmt->fmt.pix.pixelformat);
  792. if (mode2 >= 0)
  793. mode = mode2;
  794. /* else
  795. ; * no chance, return this mode */
  796. }
  797. memcpy(&fmt->fmt.pix, &gspca_dev->cam.cam_mode[mode],
  798. sizeof fmt->fmt.pix);
  799. return mode; /* used when s_fmt */
  800. }
  801. static int vidioc_try_fmt_vid_cap(struct file *file,
  802. void *priv,
  803. struct v4l2_format *fmt)
  804. {
  805. struct gspca_dev *gspca_dev = priv;
  806. int ret;
  807. ret = try_fmt_vid_cap(gspca_dev, fmt);
  808. if (ret < 0)
  809. return ret;
  810. return 0;
  811. }
  812. static int vidioc_s_fmt_vid_cap(struct file *file, void *priv,
  813. struct v4l2_format *fmt)
  814. {
  815. struct gspca_dev *gspca_dev = priv;
  816. int ret;
  817. if (mutex_lock_interruptible(&gspca_dev->queue_lock))
  818. return -ERESTARTSYS;
  819. ret = try_fmt_vid_cap(gspca_dev, fmt);
  820. if (ret < 0)
  821. goto out;
  822. if (gspca_dev->nframes != 0
  823. && fmt->fmt.pix.sizeimage > gspca_dev->frsz) {
  824. ret = -EINVAL;
  825. goto out;
  826. }
  827. if (ret == gspca_dev->curr_mode) {
  828. ret = 0;
  829. goto out; /* same mode */
  830. }
  831. if (gspca_dev->streaming) {
  832. ret = -EBUSY;
  833. goto out;
  834. }
  835. gspca_dev->width = fmt->fmt.pix.width;
  836. gspca_dev->height = fmt->fmt.pix.height;
  837. gspca_dev->pixfmt = fmt->fmt.pix.pixelformat;
  838. gspca_dev->curr_mode = ret;
  839. ret = 0;
  840. out:
  841. mutex_unlock(&gspca_dev->queue_lock);
  842. return ret;
  843. }
  844. static int vidioc_enum_framesizes(struct file *file, void *priv,
  845. struct v4l2_frmsizeenum *fsize)
  846. {
  847. struct gspca_dev *gspca_dev = priv;
  848. int i;
  849. __u32 index = 0;
  850. for (i = 0; i < gspca_dev->cam.nmodes; i++) {
  851. if (fsize->pixel_format !=
  852. gspca_dev->cam.cam_mode[i].pixelformat)
  853. continue;
  854. if (fsize->index == index) {
  855. fsize->type = V4L2_FRMSIZE_TYPE_DISCRETE;
  856. fsize->discrete.width =
  857. gspca_dev->cam.cam_mode[i].width;
  858. fsize->discrete.height =
  859. gspca_dev->cam.cam_mode[i].height;
  860. return 0;
  861. }
  862. index++;
  863. }
  864. return -EINVAL;
  865. }
  866. static void gspca_release(struct video_device *vfd)
  867. {
  868. struct gspca_dev *gspca_dev = container_of(vfd, struct gspca_dev, vdev);
  869. PDEBUG(D_STREAM, "device released");
  870. kfree(gspca_dev->usb_buf);
  871. kfree(gspca_dev);
  872. }
  873. static int dev_open(struct file *file)
  874. {
  875. struct gspca_dev *gspca_dev;
  876. int ret;
  877. PDEBUG(D_STREAM, "%s open", current->comm);
  878. gspca_dev = (struct gspca_dev *) video_devdata(file);
  879. if (mutex_lock_interruptible(&gspca_dev->queue_lock))
  880. return -ERESTARTSYS;
  881. if (!gspca_dev->present) {
  882. ret = -ENODEV;
  883. goto out;
  884. }
  885. if (gspca_dev->users > 4) { /* (arbitrary value) */
  886. ret = -EBUSY;
  887. goto out;
  888. }
  889. /* protect the subdriver against rmmod */
  890. if (!try_module_get(gspca_dev->module)) {
  891. ret = -ENODEV;
  892. goto out;
  893. }
  894. gspca_dev->users++;
  895. file->private_data = gspca_dev;
  896. #ifdef GSPCA_DEBUG
  897. /* activate the v4l2 debug */
  898. if (gspca_debug & D_V4L2)
  899. gspca_dev->vdev.debug |= V4L2_DEBUG_IOCTL
  900. | V4L2_DEBUG_IOCTL_ARG;
  901. else
  902. gspca_dev->vdev.debug &= ~(V4L2_DEBUG_IOCTL
  903. | V4L2_DEBUG_IOCTL_ARG);
  904. #endif
  905. ret = 0;
  906. out:
  907. mutex_unlock(&gspca_dev->queue_lock);
  908. if (ret != 0)
  909. PDEBUG(D_ERR|D_STREAM, "open failed err %d", ret);
  910. else
  911. PDEBUG(D_STREAM, "open done");
  912. return ret;
  913. }
  914. static int dev_close(struct file *file)
  915. {
  916. struct gspca_dev *gspca_dev = file->private_data;
  917. PDEBUG(D_STREAM, "%s close", current->comm);
  918. if (mutex_lock_interruptible(&gspca_dev->queue_lock))
  919. return -ERESTARTSYS;
  920. gspca_dev->users--;
  921. /* if the file did the capture, free the streaming resources */
  922. if (gspca_dev->capt_file == file) {
  923. if (gspca_dev->streaming) {
  924. mutex_lock(&gspca_dev->usb_lock);
  925. gspca_stream_off(gspca_dev);
  926. mutex_unlock(&gspca_dev->usb_lock);
  927. }
  928. frame_free(gspca_dev);
  929. gspca_dev->capt_file = NULL;
  930. gspca_dev->memory = GSPCA_MEMORY_NO;
  931. }
  932. file->private_data = NULL;
  933. module_put(gspca_dev->module);
  934. mutex_unlock(&gspca_dev->queue_lock);
  935. PDEBUG(D_STREAM, "close done");
  936. return 0;
  937. }
  938. static int vidioc_querycap(struct file *file, void *priv,
  939. struct v4l2_capability *cap)
  940. {
  941. struct gspca_dev *gspca_dev = priv;
  942. int ret;
  943. /* protect the access to the usb device */
  944. if (mutex_lock_interruptible(&gspca_dev->usb_lock))
  945. return -ERESTARTSYS;
  946. if (!gspca_dev->present) {
  947. ret = -ENODEV;
  948. goto out;
  949. }
  950. strncpy(cap->driver, gspca_dev->sd_desc->name, sizeof cap->driver);
  951. if (gspca_dev->dev->product != NULL) {
  952. strncpy(cap->card, gspca_dev->dev->product,
  953. sizeof cap->card);
  954. } else {
  955. snprintf(cap->card, sizeof cap->card,
  956. "USB Camera (%04x:%04x)",
  957. le16_to_cpu(gspca_dev->dev->descriptor.idVendor),
  958. le16_to_cpu(gspca_dev->dev->descriptor.idProduct));
  959. }
  960. usb_make_path(gspca_dev->dev, cap->bus_info, sizeof(cap->bus_info));
  961. cap->version = DRIVER_VERSION_NUMBER;
  962. cap->capabilities = V4L2_CAP_VIDEO_CAPTURE
  963. | V4L2_CAP_STREAMING
  964. | V4L2_CAP_READWRITE;
  965. ret = 0;
  966. out:
  967. mutex_unlock(&gspca_dev->usb_lock);
  968. return ret;
  969. }
  970. static const struct ctrl *get_ctrl(struct gspca_dev *gspca_dev,
  971. int id)
  972. {
  973. const struct ctrl *ctrls;
  974. int i;
  975. for (i = 0, ctrls = gspca_dev->sd_desc->ctrls;
  976. i < gspca_dev->sd_desc->nctrls;
  977. i++, ctrls++) {
  978. if (gspca_dev->ctrl_dis & (1 << i))
  979. continue;
  980. if (id == ctrls->qctrl.id)
  981. return ctrls;
  982. }
  983. return NULL;
  984. }
  985. static int vidioc_queryctrl(struct file *file, void *priv,
  986. struct v4l2_queryctrl *q_ctrl)
  987. {
  988. struct gspca_dev *gspca_dev = priv;
  989. const struct ctrl *ctrls;
  990. int i;
  991. u32 id;
  992. ctrls = NULL;
  993. id = q_ctrl->id;
  994. if (id & V4L2_CTRL_FLAG_NEXT_CTRL) {
  995. id &= V4L2_CTRL_ID_MASK;
  996. id++;
  997. for (i = 0; i < gspca_dev->sd_desc->nctrls; i++) {
  998. if (gspca_dev->ctrl_dis & (1 << i))
  999. continue;
  1000. if (gspca_dev->sd_desc->ctrls[i].qctrl.id < id)
  1001. continue;
  1002. if (ctrls && gspca_dev->sd_desc->ctrls[i].qctrl.id
  1003. > ctrls->qctrl.id)
  1004. continue;
  1005. ctrls = &gspca_dev->sd_desc->ctrls[i];
  1006. }
  1007. } else {
  1008. ctrls = get_ctrl(gspca_dev, id);
  1009. }
  1010. if (ctrls == NULL)
  1011. return -EINVAL;
  1012. memcpy(q_ctrl, ctrls, sizeof *q_ctrl);
  1013. return 0;
  1014. }
  1015. static int vidioc_s_ctrl(struct file *file, void *priv,
  1016. struct v4l2_control *ctrl)
  1017. {
  1018. struct gspca_dev *gspca_dev = priv;
  1019. const struct ctrl *ctrls;
  1020. int ret;
  1021. ctrls = get_ctrl(gspca_dev, ctrl->id);
  1022. if (ctrls == NULL)
  1023. return -EINVAL;
  1024. if (ctrl->value < ctrls->qctrl.minimum
  1025. || ctrl->value > ctrls->qctrl.maximum)
  1026. return -ERANGE;
  1027. PDEBUG(D_CONF, "set ctrl [%08x] = %d", ctrl->id, ctrl->value);
  1028. if (mutex_lock_interruptible(&gspca_dev->usb_lock))
  1029. return -ERESTARTSYS;
  1030. if (gspca_dev->present)
  1031. ret = ctrls->set(gspca_dev, ctrl->value);
  1032. else
  1033. ret = -ENODEV;
  1034. mutex_unlock(&gspca_dev->usb_lock);
  1035. return ret;
  1036. }
  1037. static int vidioc_g_ctrl(struct file *file, void *priv,
  1038. struct v4l2_control *ctrl)
  1039. {
  1040. struct gspca_dev *gspca_dev = priv;
  1041. const struct ctrl *ctrls;
  1042. int ret;
  1043. ctrls = get_ctrl(gspca_dev, ctrl->id);
  1044. if (ctrls == NULL)
  1045. return -EINVAL;
  1046. if (mutex_lock_interruptible(&gspca_dev->usb_lock))
  1047. return -ERESTARTSYS;
  1048. if (gspca_dev->present)
  1049. ret = ctrls->get(gspca_dev, &ctrl->value);
  1050. else
  1051. ret = -ENODEV;
  1052. mutex_unlock(&gspca_dev->usb_lock);
  1053. return ret;
  1054. }
  1055. /*fixme: have an audio flag in gspca_dev?*/
  1056. static int vidioc_s_audio(struct file *file, void *priv,
  1057. struct v4l2_audio *audio)
  1058. {
  1059. if (audio->index != 0)
  1060. return -EINVAL;
  1061. return 0;
  1062. }
  1063. static int vidioc_g_audio(struct file *file, void *priv,
  1064. struct v4l2_audio *audio)
  1065. {
  1066. strcpy(audio->name, "Microphone");
  1067. return 0;
  1068. }
  1069. static int vidioc_enumaudio(struct file *file, void *priv,
  1070. struct v4l2_audio *audio)
  1071. {
  1072. if (audio->index != 0)
  1073. return -EINVAL;
  1074. strcpy(audio->name, "Microphone");
  1075. audio->capability = 0;
  1076. audio->mode = 0;
  1077. return 0;
  1078. }
  1079. static int vidioc_querymenu(struct file *file, void *priv,
  1080. struct v4l2_querymenu *qmenu)
  1081. {
  1082. struct gspca_dev *gspca_dev = priv;
  1083. if (!gspca_dev->sd_desc->querymenu)
  1084. return -EINVAL;
  1085. return gspca_dev->sd_desc->querymenu(gspca_dev, qmenu);
  1086. }
  1087. static int vidioc_enum_input(struct file *file, void *priv,
  1088. struct v4l2_input *input)
  1089. {
  1090. struct gspca_dev *gspca_dev = priv;
  1091. if (input->index != 0)
  1092. return -EINVAL;
  1093. input->type = V4L2_INPUT_TYPE_CAMERA;
  1094. input->status = gspca_dev->cam.input_flags;
  1095. strncpy(input->name, gspca_dev->sd_desc->name,
  1096. sizeof input->name);
  1097. return 0;
  1098. }
  1099. static int vidioc_g_input(struct file *file, void *priv, unsigned int *i)
  1100. {
  1101. *i = 0;
  1102. return 0;
  1103. }
  1104. static int vidioc_s_input(struct file *file, void *priv, unsigned int i)
  1105. {
  1106. if (i > 0)
  1107. return -EINVAL;
  1108. return (0);
  1109. }
  1110. static int vidioc_reqbufs(struct file *file, void *priv,
  1111. struct v4l2_requestbuffers *rb)
  1112. {
  1113. struct gspca_dev *gspca_dev = priv;
  1114. int i, ret = 0;
  1115. switch (rb->memory) {
  1116. case GSPCA_MEMORY_READ: /* (internal call) */
  1117. case V4L2_MEMORY_MMAP:
  1118. case V4L2_MEMORY_USERPTR:
  1119. break;
  1120. default:
  1121. return -EINVAL;
  1122. }
  1123. if (mutex_lock_interruptible(&gspca_dev->queue_lock))
  1124. return -ERESTARTSYS;
  1125. if (gspca_dev->memory != GSPCA_MEMORY_NO
  1126. && gspca_dev->memory != rb->memory) {
  1127. ret = -EBUSY;
  1128. goto out;
  1129. }
  1130. /* only one file may do the capture */
  1131. if (gspca_dev->capt_file != NULL
  1132. && gspca_dev->capt_file != file) {
  1133. ret = -EBUSY;
  1134. goto out;
  1135. }
  1136. /* if allocated, the buffers must not be mapped */
  1137. for (i = 0; i < gspca_dev->nframes; i++) {
  1138. if (gspca_dev->frame[i].vma_use_count) {
  1139. ret = -EBUSY;
  1140. goto out;
  1141. }
  1142. }
  1143. /* stop streaming */
  1144. if (gspca_dev->streaming) {
  1145. mutex_lock(&gspca_dev->usb_lock);
  1146. gspca_stream_off(gspca_dev);
  1147. mutex_unlock(&gspca_dev->usb_lock);
  1148. }
  1149. /* free the previous allocated buffers, if any */
  1150. if (gspca_dev->nframes != 0) {
  1151. frame_free(gspca_dev);
  1152. gspca_dev->capt_file = NULL;
  1153. }
  1154. if (rb->count == 0) /* unrequest */
  1155. goto out;
  1156. gspca_dev->memory = rb->memory;
  1157. ret = frame_alloc(gspca_dev, rb->count);
  1158. if (ret == 0) {
  1159. rb->count = gspca_dev->nframes;
  1160. gspca_dev->capt_file = file;
  1161. }
  1162. out:
  1163. mutex_unlock(&gspca_dev->queue_lock);
  1164. PDEBUG(D_STREAM, "reqbufs st:%d c:%d", ret, rb->count);
  1165. return ret;
  1166. }
  1167. static int vidioc_querybuf(struct file *file, void *priv,
  1168. struct v4l2_buffer *v4l2_buf)
  1169. {
  1170. struct gspca_dev *gspca_dev = priv;
  1171. struct gspca_frame *frame;
  1172. if (v4l2_buf->index < 0
  1173. || v4l2_buf->index >= gspca_dev->nframes)
  1174. return -EINVAL;
  1175. frame = &gspca_dev->frame[v4l2_buf->index];
  1176. memcpy(v4l2_buf, &frame->v4l2_buf, sizeof *v4l2_buf);
  1177. return 0;
  1178. }
  1179. static int vidioc_streamon(struct file *file, void *priv,
  1180. enum v4l2_buf_type buf_type)
  1181. {
  1182. struct gspca_dev *gspca_dev = priv;
  1183. int ret;
  1184. if (buf_type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
  1185. return -EINVAL;
  1186. if (mutex_lock_interruptible(&gspca_dev->queue_lock))
  1187. return -ERESTARTSYS;
  1188. if (gspca_dev->nframes == 0
  1189. || !(gspca_dev->frame[0].v4l2_buf.flags & V4L2_BUF_FLAG_QUEUED)) {
  1190. ret = -EINVAL;
  1191. goto out;
  1192. }
  1193. if (!gspca_dev->streaming) {
  1194. ret = gspca_init_transfer(gspca_dev);
  1195. if (ret < 0)
  1196. goto out;
  1197. }
  1198. #ifdef GSPCA_DEBUG
  1199. if (gspca_debug & D_STREAM) {
  1200. PDEBUG_MODE("stream on OK",
  1201. gspca_dev->pixfmt,
  1202. gspca_dev->width,
  1203. gspca_dev->height);
  1204. }
  1205. #endif
  1206. ret = 0;
  1207. out:
  1208. mutex_unlock(&gspca_dev->queue_lock);
  1209. return ret;
  1210. }
  1211. static int vidioc_streamoff(struct file *file, void *priv,
  1212. enum v4l2_buf_type buf_type)
  1213. {
  1214. struct gspca_dev *gspca_dev = priv;
  1215. int i, ret;
  1216. if (buf_type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
  1217. return -EINVAL;
  1218. if (!gspca_dev->streaming)
  1219. return 0;
  1220. if (mutex_lock_interruptible(&gspca_dev->queue_lock))
  1221. return -ERESTARTSYS;
  1222. /* stop streaming */
  1223. if (mutex_lock_interruptible(&gspca_dev->usb_lock)) {
  1224. ret = -ERESTARTSYS;
  1225. goto out;
  1226. }
  1227. gspca_stream_off(gspca_dev);
  1228. mutex_unlock(&gspca_dev->usb_lock);
  1229. /* empty the application queues */
  1230. for (i = 0; i < gspca_dev->nframes; i++)
  1231. gspca_dev->frame[i].v4l2_buf.flags &= ~BUF_ALL_FLAGS;
  1232. gspca_dev->fr_i = gspca_dev->fr_o = gspca_dev->fr_q = 0;
  1233. gspca_dev->last_packet_type = DISCARD_PACKET;
  1234. gspca_dev->sequence = 0;
  1235. ret = 0;
  1236. out:
  1237. mutex_unlock(&gspca_dev->queue_lock);
  1238. return ret;
  1239. }
  1240. static int vidioc_g_jpegcomp(struct file *file, void *priv,
  1241. struct v4l2_jpegcompression *jpegcomp)
  1242. {
  1243. struct gspca_dev *gspca_dev = priv;
  1244. int ret;
  1245. if (!gspca_dev->sd_desc->get_jcomp)
  1246. return -EINVAL;
  1247. if (mutex_lock_interruptible(&gspca_dev->usb_lock))
  1248. return -ERESTARTSYS;
  1249. if (gspca_dev->present)
  1250. ret = gspca_dev->sd_desc->get_jcomp(gspca_dev, jpegcomp);
  1251. else
  1252. ret = -ENODEV;
  1253. mutex_unlock(&gspca_dev->usb_lock);
  1254. return ret;
  1255. }
  1256. static int vidioc_s_jpegcomp(struct file *file, void *priv,
  1257. struct v4l2_jpegcompression *jpegcomp)
  1258. {
  1259. struct gspca_dev *gspca_dev = priv;
  1260. int ret;
  1261. if (!gspca_dev->sd_desc->set_jcomp)
  1262. return -EINVAL;
  1263. if (mutex_lock_interruptible(&gspca_dev->usb_lock))
  1264. return -ERESTARTSYS;
  1265. if (gspca_dev->present)
  1266. ret = gspca_dev->sd_desc->set_jcomp(gspca_dev, jpegcomp);
  1267. else
  1268. ret = -ENODEV;
  1269. mutex_unlock(&gspca_dev->usb_lock);
  1270. return ret;
  1271. }
  1272. static int vidioc_g_parm(struct file *filp, void *priv,
  1273. struct v4l2_streamparm *parm)
  1274. {
  1275. struct gspca_dev *gspca_dev = priv;
  1276. parm->parm.capture.readbuffers = gspca_dev->nbufread;
  1277. if (gspca_dev->sd_desc->get_streamparm) {
  1278. int ret;
  1279. if (mutex_lock_interruptible(&gspca_dev->usb_lock))
  1280. return -ERESTARTSYS;
  1281. if (gspca_dev->present)
  1282. ret = gspca_dev->sd_desc->get_streamparm(gspca_dev,
  1283. parm);
  1284. else
  1285. ret = -ENODEV;
  1286. mutex_unlock(&gspca_dev->usb_lock);
  1287. return ret;
  1288. }
  1289. return 0;
  1290. }
  1291. static int vidioc_s_parm(struct file *filp, void *priv,
  1292. struct v4l2_streamparm *parm)
  1293. {
  1294. struct gspca_dev *gspca_dev = priv;
  1295. int n;
  1296. n = parm->parm.capture.readbuffers;
  1297. if (n == 0 || n > GSPCA_MAX_FRAMES)
  1298. parm->parm.capture.readbuffers = gspca_dev->nbufread;
  1299. else
  1300. gspca_dev->nbufread = n;
  1301. if (gspca_dev->sd_desc->set_streamparm) {
  1302. int ret;
  1303. if (mutex_lock_interruptible(&gspca_dev->usb_lock))
  1304. return -ERESTARTSYS;
  1305. if (gspca_dev->present)
  1306. ret = gspca_dev->sd_desc->set_streamparm(gspca_dev,
  1307. parm);
  1308. else
  1309. ret = -ENODEV;
  1310. mutex_unlock(&gspca_dev->usb_lock);
  1311. return ret;
  1312. }
  1313. return 0;
  1314. }
  1315. #ifdef CONFIG_VIDEO_V4L1_COMPAT
  1316. static int vidiocgmbuf(struct file *file, void *priv,
  1317. struct video_mbuf *mbuf)
  1318. {
  1319. struct gspca_dev *gspca_dev = file->private_data;
  1320. int i;
  1321. PDEBUG(D_STREAM, "cgmbuf");
  1322. if (gspca_dev->nframes == 0) {
  1323. int ret;
  1324. {
  1325. struct v4l2_format fmt;
  1326. fmt.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
  1327. i = gspca_dev->cam.nmodes - 1; /* highest mode */
  1328. fmt.fmt.pix.width = gspca_dev->cam.cam_mode[i].width;
  1329. fmt.fmt.pix.height = gspca_dev->cam.cam_mode[i].height;
  1330. fmt.fmt.pix.pixelformat = V4L2_PIX_FMT_BGR24;
  1331. ret = vidioc_s_fmt_vid_cap(file, priv, &fmt);
  1332. if (ret != 0)
  1333. return ret;
  1334. }
  1335. {
  1336. struct v4l2_requestbuffers rb;
  1337. memset(&rb, 0, sizeof rb);
  1338. rb.count = 4;
  1339. rb.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
  1340. rb.memory = V4L2_MEMORY_MMAP;
  1341. ret = vidioc_reqbufs(file, priv, &rb);
  1342. if (ret != 0)
  1343. return ret;
  1344. }
  1345. }
  1346. mbuf->frames = gspca_dev->nframes;
  1347. mbuf->size = gspca_dev->frsz * gspca_dev->nframes;
  1348. for (i = 0; i < mbuf->frames; i++)
  1349. mbuf->offsets[i] = gspca_dev->frame[i].v4l2_buf.m.offset;
  1350. return 0;
  1351. }
  1352. #endif
  1353. static int dev_mmap(struct file *file, struct vm_area_struct *vma)
  1354. {
  1355. struct gspca_dev *gspca_dev = file->private_data;
  1356. struct gspca_frame *frame;
  1357. struct page *page;
  1358. unsigned long addr, start, size;
  1359. int i, ret;
  1360. start = vma->vm_start;
  1361. size = vma->vm_end - vma->vm_start;
  1362. PDEBUG(D_STREAM, "mmap start:%08x size:%d", (int) start, (int) size);
  1363. if (mutex_lock_interruptible(&gspca_dev->queue_lock))
  1364. return -ERESTARTSYS;
  1365. if (!gspca_dev->present) {
  1366. ret = -ENODEV;
  1367. goto out;
  1368. }
  1369. if (gspca_dev->capt_file != file) {
  1370. ret = -EINVAL;
  1371. goto out;
  1372. }
  1373. frame = NULL;
  1374. for (i = 0; i < gspca_dev->nframes; ++i) {
  1375. if (gspca_dev->frame[i].v4l2_buf.memory != V4L2_MEMORY_MMAP) {
  1376. PDEBUG(D_STREAM, "mmap bad memory type");
  1377. break;
  1378. }
  1379. if ((gspca_dev->frame[i].v4l2_buf.m.offset >> PAGE_SHIFT)
  1380. == vma->vm_pgoff) {
  1381. frame = &gspca_dev->frame[i];
  1382. break;
  1383. }
  1384. }
  1385. if (frame == NULL) {
  1386. PDEBUG(D_STREAM, "mmap no frame buffer found");
  1387. ret = -EINVAL;
  1388. goto out;
  1389. }
  1390. #ifdef CONFIG_VIDEO_V4L1_COMPAT
  1391. /* v4l1 maps all the buffers */
  1392. if (i != 0
  1393. || size != frame->v4l2_buf.length * gspca_dev->nframes)
  1394. #endif
  1395. if (size != frame->v4l2_buf.length) {
  1396. PDEBUG(D_STREAM, "mmap bad size");
  1397. ret = -EINVAL;
  1398. goto out;
  1399. }
  1400. /*
  1401. * - VM_IO marks the area as being a mmaped region for I/O to a
  1402. * device. It also prevents the region from being core dumped.
  1403. */
  1404. vma->vm_flags |= VM_IO;
  1405. addr = (unsigned long) frame->data;
  1406. while (size > 0) {
  1407. page = vmalloc_to_page((void *) addr);
  1408. ret = vm_insert_page(vma, start, page);
  1409. if (ret < 0)
  1410. goto out;
  1411. start += PAGE_SIZE;
  1412. addr += PAGE_SIZE;
  1413. size -= PAGE_SIZE;
  1414. }
  1415. vma->vm_ops = &gspca_vm_ops;
  1416. vma->vm_private_data = frame;
  1417. gspca_vm_open(vma);
  1418. ret = 0;
  1419. out:
  1420. mutex_unlock(&gspca_dev->queue_lock);
  1421. return ret;
  1422. }
  1423. /*
  1424. * wait for a video frame
  1425. *
  1426. * If a frame is ready, its index is returned.
  1427. */
  1428. static int frame_wait(struct gspca_dev *gspca_dev,
  1429. int nonblock_ing)
  1430. {
  1431. struct gspca_frame *frame;
  1432. int i, j, ret;
  1433. /* check if a frame is ready */
  1434. i = gspca_dev->fr_o;
  1435. j = gspca_dev->fr_queue[i];
  1436. frame = &gspca_dev->frame[j];
  1437. if (!(frame->v4l2_buf.flags & V4L2_BUF_FLAG_DONE)) {
  1438. if (nonblock_ing)
  1439. return -EAGAIN;
  1440. /* wait till a frame is ready */
  1441. ret = wait_event_interruptible_timeout(gspca_dev->wq,
  1442. (frame->v4l2_buf.flags & V4L2_BUF_FLAG_DONE) ||
  1443. !gspca_dev->streaming || !gspca_dev->present,
  1444. msecs_to_jiffies(3000));
  1445. if (ret < 0)
  1446. return ret;
  1447. if (ret == 0 || !gspca_dev->streaming || !gspca_dev->present)
  1448. return -EIO;
  1449. }
  1450. gspca_dev->fr_o = (i + 1) % gspca_dev->nframes;
  1451. PDEBUG(D_FRAM, "frame wait q:%d i:%d o:%d",
  1452. gspca_dev->fr_q,
  1453. gspca_dev->fr_i,
  1454. gspca_dev->fr_o);
  1455. if (gspca_dev->sd_desc->dq_callback) {
  1456. mutex_lock(&gspca_dev->usb_lock);
  1457. if (gspca_dev->present)
  1458. gspca_dev->sd_desc->dq_callback(gspca_dev);
  1459. mutex_unlock(&gspca_dev->usb_lock);
  1460. }
  1461. return j;
  1462. }
  1463. /*
  1464. * dequeue a video buffer
  1465. *
  1466. * If nonblock_ing is false, block until a buffer is available.
  1467. */
  1468. static int vidioc_dqbuf(struct file *file, void *priv,
  1469. struct v4l2_buffer *v4l2_buf)
  1470. {
  1471. struct gspca_dev *gspca_dev = priv;
  1472. struct gspca_frame *frame;
  1473. int i, ret;
  1474. PDEBUG(D_FRAM, "dqbuf");
  1475. if (v4l2_buf->memory != gspca_dev->memory)
  1476. return -EINVAL;
  1477. if (!gspca_dev->present)
  1478. return -ENODEV;
  1479. /* if not streaming, be sure the application will not loop forever */
  1480. if (!(file->f_flags & O_NONBLOCK)
  1481. && !gspca_dev->streaming && gspca_dev->users == 1)
  1482. return -EINVAL;
  1483. /* only the capturing file may dequeue */
  1484. if (gspca_dev->capt_file != file)
  1485. return -EINVAL;
  1486. /* only one dequeue / read at a time */
  1487. if (mutex_lock_interruptible(&gspca_dev->read_lock))
  1488. return -ERESTARTSYS;
  1489. ret = frame_wait(gspca_dev, file->f_flags & O_NONBLOCK);
  1490. if (ret < 0)
  1491. goto out;
  1492. i = ret; /* frame index */
  1493. frame = &gspca_dev->frame[i];
  1494. if (gspca_dev->memory == V4L2_MEMORY_USERPTR) {
  1495. if (copy_to_user((__u8 __user *) frame->v4l2_buf.m.userptr,
  1496. frame->data,
  1497. frame->v4l2_buf.bytesused)) {
  1498. PDEBUG(D_ERR|D_STREAM,
  1499. "dqbuf cp to user failed");
  1500. ret = -EFAULT;
  1501. goto out;
  1502. }
  1503. }
  1504. frame->v4l2_buf.flags &= ~V4L2_BUF_FLAG_DONE;
  1505. memcpy(v4l2_buf, &frame->v4l2_buf, sizeof *v4l2_buf);
  1506. PDEBUG(D_FRAM, "dqbuf %d", i);
  1507. ret = 0;
  1508. out:
  1509. mutex_unlock(&gspca_dev->read_lock);
  1510. return ret;
  1511. }
  1512. /*
  1513. * queue a video buffer
  1514. *
  1515. * Attempting to queue a buffer that has already been
  1516. * queued will return -EINVAL.
  1517. */
  1518. static int vidioc_qbuf(struct file *file, void *priv,
  1519. struct v4l2_buffer *v4l2_buf)
  1520. {
  1521. struct gspca_dev *gspca_dev = priv;
  1522. struct gspca_frame *frame;
  1523. int i, index, ret;
  1524. PDEBUG(D_FRAM, "qbuf %d", v4l2_buf->index);
  1525. if (mutex_lock_interruptible(&gspca_dev->queue_lock))
  1526. return -ERESTARTSYS;
  1527. index = v4l2_buf->index;
  1528. if ((unsigned) index >= gspca_dev->nframes) {
  1529. PDEBUG(D_FRAM,
  1530. "qbuf idx %d >= %d", index, gspca_dev->nframes);
  1531. ret = -EINVAL;
  1532. goto out;
  1533. }
  1534. if (v4l2_buf->memory != gspca_dev->memory) {
  1535. PDEBUG(D_FRAM, "qbuf bad memory type");
  1536. ret = -EINVAL;
  1537. goto out;
  1538. }
  1539. frame = &gspca_dev->frame[index];
  1540. if (frame->v4l2_buf.flags & BUF_ALL_FLAGS) {
  1541. PDEBUG(D_FRAM, "qbuf bad state");
  1542. ret = -EINVAL;
  1543. goto out;
  1544. }
  1545. frame->v4l2_buf.flags |= V4L2_BUF_FLAG_QUEUED;
  1546. if (frame->v4l2_buf.memory == V4L2_MEMORY_USERPTR) {
  1547. frame->v4l2_buf.m.userptr = v4l2_buf->m.userptr;
  1548. frame->v4l2_buf.length = v4l2_buf->length;
  1549. }
  1550. /* put the buffer in the 'queued' queue */
  1551. i = gspca_dev->fr_q;
  1552. gspca_dev->fr_queue[i] = index;
  1553. gspca_dev->fr_q = (i + 1) % gspca_dev->nframes;
  1554. PDEBUG(D_FRAM, "qbuf q:%d i:%d o:%d",
  1555. gspca_dev->fr_q,
  1556. gspca_dev->fr_i,
  1557. gspca_dev->fr_o);
  1558. v4l2_buf->flags |= V4L2_BUF_FLAG_QUEUED;
  1559. v4l2_buf->flags &= ~V4L2_BUF_FLAG_DONE;
  1560. ret = 0;
  1561. out:
  1562. mutex_unlock(&gspca_dev->queue_lock);
  1563. return ret;
  1564. }
  1565. /*
  1566. * allocate the resources for read()
  1567. */
  1568. static int read_alloc(struct gspca_dev *gspca_dev,
  1569. struct file *file)
  1570. {
  1571. struct v4l2_buffer v4l2_buf;
  1572. int i, ret;
  1573. PDEBUG(D_STREAM, "read alloc");
  1574. if (gspca_dev->nframes == 0) {
  1575. struct v4l2_requestbuffers rb;
  1576. memset(&rb, 0, sizeof rb);
  1577. rb.count = gspca_dev->nbufread;
  1578. rb.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
  1579. rb.memory = GSPCA_MEMORY_READ;
  1580. ret = vidioc_reqbufs(file, gspca_dev, &rb);
  1581. if (ret != 0) {
  1582. PDEBUG(D_STREAM, "read reqbuf err %d", ret);
  1583. return ret;
  1584. }
  1585. memset(&v4l2_buf, 0, sizeof v4l2_buf);
  1586. v4l2_buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
  1587. v4l2_buf.memory = GSPCA_MEMORY_READ;
  1588. for (i = 0; i < gspca_dev->nbufread; i++) {
  1589. v4l2_buf.index = i;
  1590. ret = vidioc_qbuf(file, gspca_dev, &v4l2_buf);
  1591. if (ret != 0) {
  1592. PDEBUG(D_STREAM, "read qbuf err: %d", ret);
  1593. return ret;
  1594. }
  1595. }
  1596. gspca_dev->memory = GSPCA_MEMORY_READ;
  1597. }
  1598. /* start streaming */
  1599. ret = vidioc_streamon(file, gspca_dev, V4L2_BUF_TYPE_VIDEO_CAPTURE);
  1600. if (ret != 0)
  1601. PDEBUG(D_STREAM, "read streamon err %d", ret);
  1602. return ret;
  1603. }
  1604. static unsigned int dev_poll(struct file *file, poll_table *wait)
  1605. {
  1606. struct gspca_dev *gspca_dev = file->private_data;
  1607. int i, ret;
  1608. PDEBUG(D_FRAM, "poll");
  1609. poll_wait(file, &gspca_dev->wq, wait);
  1610. /* if reqbufs is not done, the user would use read() */
  1611. if (gspca_dev->nframes == 0) {
  1612. if (gspca_dev->memory != GSPCA_MEMORY_NO)
  1613. return POLLERR; /* not the 1st time */
  1614. ret = read_alloc(gspca_dev, file);
  1615. if (ret != 0)
  1616. return POLLERR;
  1617. }
  1618. if (mutex_lock_interruptible(&gspca_dev->queue_lock) != 0)
  1619. return POLLERR;
  1620. /* check the next incoming buffer */
  1621. i = gspca_dev->fr_o;
  1622. i = gspca_dev->fr_queue[i];
  1623. if (gspca_dev->frame[i].v4l2_buf.flags & V4L2_BUF_FLAG_DONE)
  1624. ret = POLLIN | POLLRDNORM; /* something to read */
  1625. else
  1626. ret = 0;
  1627. mutex_unlock(&gspca_dev->queue_lock);
  1628. if (!gspca_dev->present)
  1629. return POLLHUP;
  1630. return ret;
  1631. }
  1632. static ssize_t dev_read(struct file *file, char __user *data,
  1633. size_t count, loff_t *ppos)
  1634. {
  1635. struct gspca_dev *gspca_dev = file->private_data;
  1636. struct gspca_frame *frame;
  1637. struct v4l2_buffer v4l2_buf;
  1638. struct timeval timestamp;
  1639. int n, ret, ret2;
  1640. PDEBUG(D_FRAM, "read (%zd)", count);
  1641. if (!gspca_dev->present)
  1642. return -ENODEV;
  1643. switch (gspca_dev->memory) {
  1644. case GSPCA_MEMORY_NO: /* first time */
  1645. ret = read_alloc(gspca_dev, file);
  1646. if (ret != 0)
  1647. return ret;
  1648. break;
  1649. case GSPCA_MEMORY_READ:
  1650. if (gspca_dev->capt_file == file)
  1651. break;
  1652. /* fall thru */
  1653. default:
  1654. return -EINVAL;
  1655. }
  1656. /* get a frame */
  1657. jiffies_to_timeval(get_jiffies_64(), &timestamp);
  1658. timestamp.tv_sec--;
  1659. n = 2;
  1660. for (;;) {
  1661. memset(&v4l2_buf, 0, sizeof v4l2_buf);
  1662. v4l2_buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
  1663. v4l2_buf.memory = GSPCA_MEMORY_READ;
  1664. ret = vidioc_dqbuf(file, gspca_dev, &v4l2_buf);
  1665. if (ret != 0) {
  1666. PDEBUG(D_STREAM, "read dqbuf err %d", ret);
  1667. return ret;
  1668. }
  1669. /* if the process slept for more than 1 second,
  1670. * get a newer frame */
  1671. frame = &gspca_dev->frame[v4l2_buf.index];
  1672. if (--n < 0)
  1673. break; /* avoid infinite loop */
  1674. if (frame->v4l2_buf.timestamp.tv_sec >= timestamp.tv_sec)
  1675. break;
  1676. ret = vidioc_qbuf(file, gspca_dev, &v4l2_buf);
  1677. if (ret != 0) {
  1678. PDEBUG(D_STREAM, "read qbuf err %d", ret);
  1679. return ret;
  1680. }
  1681. }
  1682. /* copy the frame */
  1683. if (count > frame->v4l2_buf.bytesused)
  1684. count = frame->v4l2_buf.bytesused;
  1685. ret = copy_to_user(data, frame->data, count);
  1686. if (ret != 0) {
  1687. PDEBUG(D_ERR|D_STREAM,
  1688. "read cp to user lack %d / %zd", ret, count);
  1689. ret = -EFAULT;
  1690. goto out;
  1691. }
  1692. ret = count;
  1693. out:
  1694. /* in each case, requeue the buffer */
  1695. ret2 = vidioc_qbuf(file, gspca_dev, &v4l2_buf);
  1696. if (ret2 != 0)
  1697. return ret2;
  1698. return ret;
  1699. }
  1700. static struct v4l2_file_operations dev_fops = {
  1701. .owner = THIS_MODULE,
  1702. .open = dev_open,
  1703. .release = dev_close,
  1704. .read = dev_read,
  1705. .mmap = dev_mmap,
  1706. .unlocked_ioctl = video_ioctl2,
  1707. .poll = dev_poll,
  1708. };
  1709. static const struct v4l2_ioctl_ops dev_ioctl_ops = {
  1710. .vidioc_querycap = vidioc_querycap,
  1711. .vidioc_dqbuf = vidioc_dqbuf,
  1712. .vidioc_qbuf = vidioc_qbuf,
  1713. .vidioc_enum_fmt_vid_cap = vidioc_enum_fmt_vid_cap,
  1714. .vidioc_try_fmt_vid_cap = vidioc_try_fmt_vid_cap,
  1715. .vidioc_g_fmt_vid_cap = vidioc_g_fmt_vid_cap,
  1716. .vidioc_s_fmt_vid_cap = vidioc_s_fmt_vid_cap,
  1717. .vidioc_streamon = vidioc_streamon,
  1718. .vidioc_queryctrl = vidioc_queryctrl,
  1719. .vidioc_g_ctrl = vidioc_g_ctrl,
  1720. .vidioc_s_ctrl = vidioc_s_ctrl,
  1721. .vidioc_g_audio = vidioc_g_audio,
  1722. .vidioc_s_audio = vidioc_s_audio,
  1723. .vidioc_enumaudio = vidioc_enumaudio,
  1724. .vidioc_querymenu = vidioc_querymenu,
  1725. .vidioc_enum_input = vidioc_enum_input,
  1726. .vidioc_g_input = vidioc_g_input,
  1727. .vidioc_s_input = vidioc_s_input,
  1728. .vidioc_reqbufs = vidioc_reqbufs,
  1729. .vidioc_querybuf = vidioc_querybuf,
  1730. .vidioc_streamoff = vidioc_streamoff,
  1731. .vidioc_g_jpegcomp = vidioc_g_jpegcomp,
  1732. .vidioc_s_jpegcomp = vidioc_s_jpegcomp,
  1733. .vidioc_g_parm = vidioc_g_parm,
  1734. .vidioc_s_parm = vidioc_s_parm,
  1735. .vidioc_enum_framesizes = vidioc_enum_framesizes,
  1736. #ifdef CONFIG_VIDEO_ADV_DEBUG
  1737. .vidioc_g_register = vidioc_g_register,
  1738. .vidioc_s_register = vidioc_s_register,
  1739. #endif
  1740. .vidioc_g_chip_ident = vidioc_g_chip_ident,
  1741. #ifdef CONFIG_VIDEO_V4L1_COMPAT
  1742. .vidiocgmbuf = vidiocgmbuf,
  1743. #endif
  1744. };
  1745. static struct video_device gspca_template = {
  1746. .name = "gspca main driver",
  1747. .fops = &dev_fops,
  1748. .ioctl_ops = &dev_ioctl_ops,
  1749. .release = gspca_release,
  1750. .minor = -1,
  1751. };
  1752. /*
  1753. * probe and create a new gspca device
  1754. *
  1755. * This function must be called by the sub-driver when it is
  1756. * called for probing a new device.
  1757. */
  1758. int gspca_dev_probe(struct usb_interface *intf,
  1759. const struct usb_device_id *id,
  1760. const struct sd_desc *sd_desc,
  1761. int dev_size,
  1762. struct module *module)
  1763. {
  1764. struct usb_interface_descriptor *interface;
  1765. struct gspca_dev *gspca_dev;
  1766. struct usb_device *dev = interface_to_usbdev(intf);
  1767. int ret;
  1768. PDEBUG(D_PROBE, "probing %04x:%04x", id->idVendor, id->idProduct);
  1769. /* we don't handle multi-config cameras */
  1770. if (dev->descriptor.bNumConfigurations != 1)
  1771. return -ENODEV;
  1772. interface = &intf->cur_altsetting->desc;
  1773. if (interface->bInterfaceNumber > 0)
  1774. return -ENODEV;
  1775. /* create the device */
  1776. if (dev_size < sizeof *gspca_dev)
  1777. dev_size = sizeof *gspca_dev;
  1778. gspca_dev = kzalloc(dev_size, GFP_KERNEL);
  1779. if (!gspca_dev) {
  1780. err("couldn't kzalloc gspca struct");
  1781. return -ENOMEM;
  1782. }
  1783. gspca_dev->usb_buf = kmalloc(USB_BUF_SZ, GFP_KERNEL);
  1784. if (!gspca_dev->usb_buf) {
  1785. err("out of memory");
  1786. ret = -ENOMEM;
  1787. goto out;
  1788. }
  1789. gspca_dev->dev = dev;
  1790. gspca_dev->iface = interface->bInterfaceNumber;
  1791. gspca_dev->nbalt = intf->num_altsetting;
  1792. gspca_dev->sd_desc = sd_desc;
  1793. gspca_dev->nbufread = 2;
  1794. gspca_dev->empty_packet = -1; /* don't check the empty packets */
  1795. /* configure the subdriver and initialize the USB device */
  1796. ret = sd_desc->config(gspca_dev, id);
  1797. if (ret < 0)
  1798. goto out;
  1799. ret = sd_desc->init(gspca_dev);
  1800. if (ret < 0)
  1801. goto out;
  1802. ret = gspca_set_alt0(gspca_dev);
  1803. if (ret < 0)
  1804. goto out;
  1805. gspca_set_default_mode(gspca_dev);
  1806. mutex_init(&gspca_dev->usb_lock);
  1807. mutex_init(&gspca_dev->read_lock);
  1808. mutex_init(&gspca_dev->queue_lock);
  1809. init_waitqueue_head(&gspca_dev->wq);
  1810. /* init video stuff */
  1811. memcpy(&gspca_dev->vdev, &gspca_template, sizeof gspca_template);
  1812. gspca_dev->vdev.parent = &intf->dev;
  1813. gspca_dev->module = module;
  1814. gspca_dev->present = 1;
  1815. ret = video_register_device(&gspca_dev->vdev,
  1816. VFL_TYPE_GRABBER,
  1817. -1);
  1818. if (ret < 0) {
  1819. err("video_register_device err %d", ret);
  1820. goto out;
  1821. }
  1822. usb_set_intfdata(intf, gspca_dev);
  1823. PDEBUG(D_PROBE, "probe ok");
  1824. return 0;
  1825. out:
  1826. kfree(gspca_dev->usb_buf);
  1827. kfree(gspca_dev);
  1828. return ret;
  1829. }
  1830. EXPORT_SYMBOL(gspca_dev_probe);
  1831. /*
  1832. * USB disconnection
  1833. *
  1834. * This function must be called by the sub-driver
  1835. * when the device disconnects, after the specific resources are freed.
  1836. */
  1837. void gspca_disconnect(struct usb_interface *intf)
  1838. {
  1839. struct gspca_dev *gspca_dev = usb_get_intfdata(intf);
  1840. mutex_lock(&gspca_dev->usb_lock);
  1841. gspca_dev->present = 0;
  1842. if (gspca_dev->streaming) {
  1843. destroy_urbs(gspca_dev);
  1844. wake_up_interruptible(&gspca_dev->wq);
  1845. }
  1846. /* the device is freed at exit of this function */
  1847. gspca_dev->dev = NULL;
  1848. mutex_unlock(&gspca_dev->usb_lock);
  1849. usb_set_intfdata(intf, NULL);
  1850. /* release the device */
  1851. /* (this will call gspca_release() immediatly or on last close) */
  1852. video_unregister_device(&gspca_dev->vdev);
  1853. PDEBUG(D_PROBE, "disconnect complete");
  1854. }
  1855. EXPORT_SYMBOL(gspca_disconnect);
  1856. #ifdef CONFIG_PM
  1857. int gspca_suspend(struct usb_interface *intf, pm_message_t message)
  1858. {
  1859. struct gspca_dev *gspca_dev = usb_get_intfdata(intf);
  1860. if (!gspca_dev->streaming)
  1861. return 0;
  1862. gspca_dev->frozen = 1; /* avoid urb error messages */
  1863. if (gspca_dev->sd_desc->stopN)
  1864. gspca_dev->sd_desc->stopN(gspca_dev);
  1865. destroy_urbs(gspca_dev);
  1866. gspca_set_alt0(gspca_dev);
  1867. if (gspca_dev->sd_desc->stop0)
  1868. gspca_dev->sd_desc->stop0(gspca_dev);
  1869. return 0;
  1870. }
  1871. EXPORT_SYMBOL(gspca_suspend);
  1872. int gspca_resume(struct usb_interface *intf)
  1873. {
  1874. struct gspca_dev *gspca_dev = usb_get_intfdata(intf);
  1875. gspca_dev->frozen = 0;
  1876. gspca_dev->sd_desc->init(gspca_dev);
  1877. if (gspca_dev->streaming)
  1878. return gspca_init_transfer(gspca_dev);
  1879. return 0;
  1880. }
  1881. EXPORT_SYMBOL(gspca_resume);
  1882. #endif
  1883. /* -- cam driver utility functions -- */
  1884. /* auto gain and exposure algorithm based on the knee algorithm described here:
  1885. http://ytse.tricolour.net/docs/LowLightOptimization.html
  1886. Returns 0 if no changes were made, 1 if the gain and or exposure settings
  1887. where changed. */
  1888. int gspca_auto_gain_n_exposure(struct gspca_dev *gspca_dev, int avg_lum,
  1889. int desired_avg_lum, int deadzone, int gain_knee, int exposure_knee)
  1890. {
  1891. int i, steps, gain, orig_gain, exposure, orig_exposure, autogain;
  1892. const struct ctrl *gain_ctrl = NULL;
  1893. const struct ctrl *exposure_ctrl = NULL;
  1894. const struct ctrl *autogain_ctrl = NULL;
  1895. int retval = 0;
  1896. for (i = 0; i < gspca_dev->sd_desc->nctrls; i++) {
  1897. if (gspca_dev->sd_desc->ctrls[i].qctrl.id == V4L2_CID_GAIN)
  1898. gain_ctrl = &gspca_dev->sd_desc->ctrls[i];
  1899. if (gspca_dev->sd_desc->ctrls[i].qctrl.id == V4L2_CID_EXPOSURE)
  1900. exposure_ctrl = &gspca_dev->sd_desc->ctrls[i];
  1901. if (gspca_dev->sd_desc->ctrls[i].qctrl.id == V4L2_CID_AUTOGAIN)
  1902. autogain_ctrl = &gspca_dev->sd_desc->ctrls[i];
  1903. }
  1904. if (!gain_ctrl || !exposure_ctrl || !autogain_ctrl) {
  1905. PDEBUG(D_ERR, "Error: gspca_auto_gain_n_exposure called "
  1906. "on cam without (auto)gain/exposure");
  1907. return 0;
  1908. }
  1909. if (gain_ctrl->get(gspca_dev, &gain) ||
  1910. exposure_ctrl->get(gspca_dev, &exposure) ||
  1911. autogain_ctrl->get(gspca_dev, &autogain) || !autogain)
  1912. return 0;
  1913. orig_gain = gain;
  1914. orig_exposure = exposure;
  1915. /* If we are of a multiple of deadzone, do multiple steps to reach the
  1916. desired lumination fast (with the risc of a slight overshoot) */
  1917. steps = abs(desired_avg_lum - avg_lum) / deadzone;
  1918. PDEBUG(D_FRAM, "autogain: lum: %d, desired: %d, steps: %d",
  1919. avg_lum, desired_avg_lum, steps);
  1920. for (i = 0; i < steps; i++) {
  1921. if (avg_lum > desired_avg_lum) {
  1922. if (gain > gain_knee)
  1923. gain--;
  1924. else if (exposure > exposure_knee)
  1925. exposure--;
  1926. else if (gain > gain_ctrl->qctrl.default_value)
  1927. gain--;
  1928. else if (exposure > exposure_ctrl->qctrl.minimum)
  1929. exposure--;
  1930. else if (gain > gain_ctrl->qctrl.minimum)
  1931. gain--;
  1932. else
  1933. break;
  1934. } else {
  1935. if (gain < gain_ctrl->qctrl.default_value)
  1936. gain++;
  1937. else if (exposure < exposure_knee)
  1938. exposure++;
  1939. else if (gain < gain_knee)
  1940. gain++;
  1941. else if (exposure < exposure_ctrl->qctrl.maximum)
  1942. exposure++;
  1943. else if (gain < gain_ctrl->qctrl.maximum)
  1944. gain++;
  1945. else
  1946. break;
  1947. }
  1948. }
  1949. if (gain != orig_gain) {
  1950. gain_ctrl->set(gspca_dev, gain);
  1951. retval = 1;
  1952. }
  1953. if (exposure != orig_exposure) {
  1954. exposure_ctrl->set(gspca_dev, exposure);
  1955. retval = 1;
  1956. }
  1957. return retval;
  1958. }
  1959. EXPORT_SYMBOL(gspca_auto_gain_n_exposure);
  1960. /* -- module insert / remove -- */
  1961. static int __init gspca_init(void)
  1962. {
  1963. info("main v%d.%d.%d registered",
  1964. (DRIVER_VERSION_NUMBER >> 16) & 0xff,
  1965. (DRIVER_VERSION_NUMBER >> 8) & 0xff,
  1966. DRIVER_VERSION_NUMBER & 0xff);
  1967. return 0;
  1968. }
  1969. static void __exit gspca_exit(void)
  1970. {
  1971. info("main deregistered");
  1972. }
  1973. module_init(gspca_init);
  1974. module_exit(gspca_exit);
  1975. #ifdef GSPCA_DEBUG
  1976. module_param_named(debug, gspca_debug, int, 0644);
  1977. MODULE_PARM_DESC(debug,
  1978. "Debug (bit) 0x01:error 0x02:probe 0x04:config"
  1979. " 0x08:stream 0x10:frame 0x20:packet 0x40:USBin 0x80:USBout"
  1980. " 0x0100: v4l2");
  1981. #endif