v4l2-ioctl.c 49 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875
  1. /*
  2. * Video capture interface for Linux version 2
  3. *
  4. * A generic framework to process V4L2 ioctl commands.
  5. *
  6. * This program is free software; you can redistribute it and/or
  7. * modify it under the terms of the GNU General Public License
  8. * as published by the Free Software Foundation; either version
  9. * 2 of the License, or (at your option) any later version.
  10. *
  11. * Authors: Alan Cox, <alan@redhat.com> (version 1)
  12. * Mauro Carvalho Chehab <mchehab@infradead.org> (version 2)
  13. */
  14. #include <linux/module.h>
  15. #include <linux/types.h>
  16. #include <linux/kernel.h>
  17. #define __OLD_VIDIOC_ /* To allow fixing old calls */
  18. #include <linux/videodev2.h>
  19. #ifdef CONFIG_VIDEO_V4L1
  20. #include <linux/videodev.h>
  21. #endif
  22. #include <media/v4l2-common.h>
  23. #include <media/v4l2-ioctl.h>
  24. #include <linux/video_decoder.h>
  25. #define dbgarg(cmd, fmt, arg...) \
  26. do { \
  27. if (vfd->debug & V4L2_DEBUG_IOCTL_ARG) { \
  28. printk(KERN_DEBUG "%s: ", vfd->name); \
  29. v4l_printk_ioctl(cmd); \
  30. printk(" " fmt, ## arg); \
  31. } \
  32. } while (0)
  33. #define dbgarg2(fmt, arg...) \
  34. do { \
  35. if (vfd->debug & V4L2_DEBUG_IOCTL_ARG) \
  36. printk(KERN_DEBUG "%s: " fmt, vfd->name, ## arg);\
  37. } while (0)
  38. struct std_descr {
  39. v4l2_std_id std;
  40. const char *descr;
  41. };
  42. static const struct std_descr standards[] = {
  43. { V4L2_STD_NTSC, "NTSC" },
  44. { V4L2_STD_NTSC_M, "NTSC-M" },
  45. { V4L2_STD_NTSC_M_JP, "NTSC-M-JP" },
  46. { V4L2_STD_NTSC_M_KR, "NTSC-M-KR" },
  47. { V4L2_STD_NTSC_443, "NTSC-443" },
  48. { V4L2_STD_PAL, "PAL" },
  49. { V4L2_STD_PAL_BG, "PAL-BG" },
  50. { V4L2_STD_PAL_B, "PAL-B" },
  51. { V4L2_STD_PAL_B1, "PAL-B1" },
  52. { V4L2_STD_PAL_G, "PAL-G" },
  53. { V4L2_STD_PAL_H, "PAL-H" },
  54. { V4L2_STD_PAL_I, "PAL-I" },
  55. { V4L2_STD_PAL_DK, "PAL-DK" },
  56. { V4L2_STD_PAL_D, "PAL-D" },
  57. { V4L2_STD_PAL_D1, "PAL-D1" },
  58. { V4L2_STD_PAL_K, "PAL-K" },
  59. { V4L2_STD_PAL_M, "PAL-M" },
  60. { V4L2_STD_PAL_N, "PAL-N" },
  61. { V4L2_STD_PAL_Nc, "PAL-Nc" },
  62. { V4L2_STD_PAL_60, "PAL-60" },
  63. { V4L2_STD_SECAM, "SECAM" },
  64. { V4L2_STD_SECAM_B, "SECAM-B" },
  65. { V4L2_STD_SECAM_G, "SECAM-G" },
  66. { V4L2_STD_SECAM_H, "SECAM-H" },
  67. { V4L2_STD_SECAM_DK, "SECAM-DK" },
  68. { V4L2_STD_SECAM_D, "SECAM-D" },
  69. { V4L2_STD_SECAM_K, "SECAM-K" },
  70. { V4L2_STD_SECAM_K1, "SECAM-K1" },
  71. { V4L2_STD_SECAM_L, "SECAM-L" },
  72. { V4L2_STD_SECAM_LC, "SECAM-Lc" },
  73. { 0, "Unknown" }
  74. };
  75. /* video4linux standard ID conversion to standard name
  76. */
  77. const char *v4l2_norm_to_name(v4l2_std_id id)
  78. {
  79. u32 myid = id;
  80. int i;
  81. /* HACK: ppc32 architecture doesn't have __ucmpdi2 function to handle
  82. 64 bit comparations. So, on that architecture, with some gcc
  83. variants, compilation fails. Currently, the max value is 30bit wide.
  84. */
  85. BUG_ON(myid != id);
  86. for (i = 0; standards[i].std; i++)
  87. if (myid == standards[i].std)
  88. break;
  89. return standards[i].descr;
  90. }
  91. EXPORT_SYMBOL(v4l2_norm_to_name);
  92. /* Fill in the fields of a v4l2_standard structure according to the
  93. 'id' and 'transmission' parameters. Returns negative on error. */
  94. int v4l2_video_std_construct(struct v4l2_standard *vs,
  95. int id, const char *name)
  96. {
  97. u32 index = vs->index;
  98. memset(vs, 0, sizeof(struct v4l2_standard));
  99. vs->index = index;
  100. vs->id = id;
  101. if (id & V4L2_STD_525_60) {
  102. vs->frameperiod.numerator = 1001;
  103. vs->frameperiod.denominator = 30000;
  104. vs->framelines = 525;
  105. } else {
  106. vs->frameperiod.numerator = 1;
  107. vs->frameperiod.denominator = 25;
  108. vs->framelines = 625;
  109. }
  110. strlcpy(vs->name, name, sizeof(vs->name));
  111. return 0;
  112. }
  113. EXPORT_SYMBOL(v4l2_video_std_construct);
  114. /* ----------------------------------------------------------------- */
  115. /* some arrays for pretty-printing debug messages of enum types */
  116. const char *v4l2_field_names[] = {
  117. [V4L2_FIELD_ANY] = "any",
  118. [V4L2_FIELD_NONE] = "none",
  119. [V4L2_FIELD_TOP] = "top",
  120. [V4L2_FIELD_BOTTOM] = "bottom",
  121. [V4L2_FIELD_INTERLACED] = "interlaced",
  122. [V4L2_FIELD_SEQ_TB] = "seq-tb",
  123. [V4L2_FIELD_SEQ_BT] = "seq-bt",
  124. [V4L2_FIELD_ALTERNATE] = "alternate",
  125. [V4L2_FIELD_INTERLACED_TB] = "interlaced-tb",
  126. [V4L2_FIELD_INTERLACED_BT] = "interlaced-bt",
  127. };
  128. EXPORT_SYMBOL(v4l2_field_names);
  129. const char *v4l2_type_names[] = {
  130. [V4L2_BUF_TYPE_VIDEO_CAPTURE] = "vid-cap",
  131. [V4L2_BUF_TYPE_VIDEO_OVERLAY] = "vid-overlay",
  132. [V4L2_BUF_TYPE_VIDEO_OUTPUT] = "vid-out",
  133. [V4L2_BUF_TYPE_VBI_CAPTURE] = "vbi-cap",
  134. [V4L2_BUF_TYPE_VBI_OUTPUT] = "vbi-out",
  135. [V4L2_BUF_TYPE_SLICED_VBI_CAPTURE] = "sliced-vbi-cap",
  136. [V4L2_BUF_TYPE_SLICED_VBI_OUTPUT] = "sliced-vbi-out",
  137. [V4L2_BUF_TYPE_VIDEO_OUTPUT_OVERLAY] = "vid-out-overlay",
  138. };
  139. EXPORT_SYMBOL(v4l2_type_names);
  140. static const char *v4l2_memory_names[] = {
  141. [V4L2_MEMORY_MMAP] = "mmap",
  142. [V4L2_MEMORY_USERPTR] = "userptr",
  143. [V4L2_MEMORY_OVERLAY] = "overlay",
  144. };
  145. #define prt_names(a, arr) ((((a) >= 0) && ((a) < ARRAY_SIZE(arr))) ? \
  146. arr[a] : "unknown")
  147. /* ------------------------------------------------------------------ */
  148. /* debug help functions */
  149. #ifdef CONFIG_VIDEO_V4L1_COMPAT
  150. static const char *v4l1_ioctls[] = {
  151. [_IOC_NR(VIDIOCGCAP)] = "VIDIOCGCAP",
  152. [_IOC_NR(VIDIOCGCHAN)] = "VIDIOCGCHAN",
  153. [_IOC_NR(VIDIOCSCHAN)] = "VIDIOCSCHAN",
  154. [_IOC_NR(VIDIOCGTUNER)] = "VIDIOCGTUNER",
  155. [_IOC_NR(VIDIOCSTUNER)] = "VIDIOCSTUNER",
  156. [_IOC_NR(VIDIOCGPICT)] = "VIDIOCGPICT",
  157. [_IOC_NR(VIDIOCSPICT)] = "VIDIOCSPICT",
  158. [_IOC_NR(VIDIOCCAPTURE)] = "VIDIOCCAPTURE",
  159. [_IOC_NR(VIDIOCGWIN)] = "VIDIOCGWIN",
  160. [_IOC_NR(VIDIOCSWIN)] = "VIDIOCSWIN",
  161. [_IOC_NR(VIDIOCGFBUF)] = "VIDIOCGFBUF",
  162. [_IOC_NR(VIDIOCSFBUF)] = "VIDIOCSFBUF",
  163. [_IOC_NR(VIDIOCKEY)] = "VIDIOCKEY",
  164. [_IOC_NR(VIDIOCGFREQ)] = "VIDIOCGFREQ",
  165. [_IOC_NR(VIDIOCSFREQ)] = "VIDIOCSFREQ",
  166. [_IOC_NR(VIDIOCGAUDIO)] = "VIDIOCGAUDIO",
  167. [_IOC_NR(VIDIOCSAUDIO)] = "VIDIOCSAUDIO",
  168. [_IOC_NR(VIDIOCSYNC)] = "VIDIOCSYNC",
  169. [_IOC_NR(VIDIOCMCAPTURE)] = "VIDIOCMCAPTURE",
  170. [_IOC_NR(VIDIOCGMBUF)] = "VIDIOCGMBUF",
  171. [_IOC_NR(VIDIOCGUNIT)] = "VIDIOCGUNIT",
  172. [_IOC_NR(VIDIOCGCAPTURE)] = "VIDIOCGCAPTURE",
  173. [_IOC_NR(VIDIOCSCAPTURE)] = "VIDIOCSCAPTURE",
  174. [_IOC_NR(VIDIOCSPLAYMODE)] = "VIDIOCSPLAYMODE",
  175. [_IOC_NR(VIDIOCSWRITEMODE)] = "VIDIOCSWRITEMODE",
  176. [_IOC_NR(VIDIOCGPLAYINFO)] = "VIDIOCGPLAYINFO",
  177. [_IOC_NR(VIDIOCSMICROCODE)] = "VIDIOCSMICROCODE",
  178. [_IOC_NR(VIDIOCGVBIFMT)] = "VIDIOCGVBIFMT",
  179. [_IOC_NR(VIDIOCSVBIFMT)] = "VIDIOCSVBIFMT"
  180. };
  181. #define V4L1_IOCTLS ARRAY_SIZE(v4l1_ioctls)
  182. #endif
  183. static const char *v4l2_ioctls[] = {
  184. [_IOC_NR(VIDIOC_QUERYCAP)] = "VIDIOC_QUERYCAP",
  185. [_IOC_NR(VIDIOC_RESERVED)] = "VIDIOC_RESERVED",
  186. [_IOC_NR(VIDIOC_ENUM_FMT)] = "VIDIOC_ENUM_FMT",
  187. [_IOC_NR(VIDIOC_G_FMT)] = "VIDIOC_G_FMT",
  188. [_IOC_NR(VIDIOC_S_FMT)] = "VIDIOC_S_FMT",
  189. [_IOC_NR(VIDIOC_REQBUFS)] = "VIDIOC_REQBUFS",
  190. [_IOC_NR(VIDIOC_QUERYBUF)] = "VIDIOC_QUERYBUF",
  191. [_IOC_NR(VIDIOC_G_FBUF)] = "VIDIOC_G_FBUF",
  192. [_IOC_NR(VIDIOC_S_FBUF)] = "VIDIOC_S_FBUF",
  193. [_IOC_NR(VIDIOC_OVERLAY)] = "VIDIOC_OVERLAY",
  194. [_IOC_NR(VIDIOC_QBUF)] = "VIDIOC_QBUF",
  195. [_IOC_NR(VIDIOC_DQBUF)] = "VIDIOC_DQBUF",
  196. [_IOC_NR(VIDIOC_STREAMON)] = "VIDIOC_STREAMON",
  197. [_IOC_NR(VIDIOC_STREAMOFF)] = "VIDIOC_STREAMOFF",
  198. [_IOC_NR(VIDIOC_G_PARM)] = "VIDIOC_G_PARM",
  199. [_IOC_NR(VIDIOC_S_PARM)] = "VIDIOC_S_PARM",
  200. [_IOC_NR(VIDIOC_G_STD)] = "VIDIOC_G_STD",
  201. [_IOC_NR(VIDIOC_S_STD)] = "VIDIOC_S_STD",
  202. [_IOC_NR(VIDIOC_ENUMSTD)] = "VIDIOC_ENUMSTD",
  203. [_IOC_NR(VIDIOC_ENUMINPUT)] = "VIDIOC_ENUMINPUT",
  204. [_IOC_NR(VIDIOC_G_CTRL)] = "VIDIOC_G_CTRL",
  205. [_IOC_NR(VIDIOC_S_CTRL)] = "VIDIOC_S_CTRL",
  206. [_IOC_NR(VIDIOC_G_TUNER)] = "VIDIOC_G_TUNER",
  207. [_IOC_NR(VIDIOC_S_TUNER)] = "VIDIOC_S_TUNER",
  208. [_IOC_NR(VIDIOC_G_AUDIO)] = "VIDIOC_G_AUDIO",
  209. [_IOC_NR(VIDIOC_S_AUDIO)] = "VIDIOC_S_AUDIO",
  210. [_IOC_NR(VIDIOC_QUERYCTRL)] = "VIDIOC_QUERYCTRL",
  211. [_IOC_NR(VIDIOC_QUERYMENU)] = "VIDIOC_QUERYMENU",
  212. [_IOC_NR(VIDIOC_G_INPUT)] = "VIDIOC_G_INPUT",
  213. [_IOC_NR(VIDIOC_S_INPUT)] = "VIDIOC_S_INPUT",
  214. [_IOC_NR(VIDIOC_G_OUTPUT)] = "VIDIOC_G_OUTPUT",
  215. [_IOC_NR(VIDIOC_S_OUTPUT)] = "VIDIOC_S_OUTPUT",
  216. [_IOC_NR(VIDIOC_ENUMOUTPUT)] = "VIDIOC_ENUMOUTPUT",
  217. [_IOC_NR(VIDIOC_G_AUDOUT)] = "VIDIOC_G_AUDOUT",
  218. [_IOC_NR(VIDIOC_S_AUDOUT)] = "VIDIOC_S_AUDOUT",
  219. [_IOC_NR(VIDIOC_G_MODULATOR)] = "VIDIOC_G_MODULATOR",
  220. [_IOC_NR(VIDIOC_S_MODULATOR)] = "VIDIOC_S_MODULATOR",
  221. [_IOC_NR(VIDIOC_G_FREQUENCY)] = "VIDIOC_G_FREQUENCY",
  222. [_IOC_NR(VIDIOC_S_FREQUENCY)] = "VIDIOC_S_FREQUENCY",
  223. [_IOC_NR(VIDIOC_CROPCAP)] = "VIDIOC_CROPCAP",
  224. [_IOC_NR(VIDIOC_G_CROP)] = "VIDIOC_G_CROP",
  225. [_IOC_NR(VIDIOC_S_CROP)] = "VIDIOC_S_CROP",
  226. [_IOC_NR(VIDIOC_G_JPEGCOMP)] = "VIDIOC_G_JPEGCOMP",
  227. [_IOC_NR(VIDIOC_S_JPEGCOMP)] = "VIDIOC_S_JPEGCOMP",
  228. [_IOC_NR(VIDIOC_QUERYSTD)] = "VIDIOC_QUERYSTD",
  229. [_IOC_NR(VIDIOC_TRY_FMT)] = "VIDIOC_TRY_FMT",
  230. [_IOC_NR(VIDIOC_ENUMAUDIO)] = "VIDIOC_ENUMAUDIO",
  231. [_IOC_NR(VIDIOC_ENUMAUDOUT)] = "VIDIOC_ENUMAUDOUT",
  232. [_IOC_NR(VIDIOC_G_PRIORITY)] = "VIDIOC_G_PRIORITY",
  233. [_IOC_NR(VIDIOC_S_PRIORITY)] = "VIDIOC_S_PRIORITY",
  234. [_IOC_NR(VIDIOC_G_SLICED_VBI_CAP)] = "VIDIOC_G_SLICED_VBI_CAP",
  235. [_IOC_NR(VIDIOC_LOG_STATUS)] = "VIDIOC_LOG_STATUS",
  236. [_IOC_NR(VIDIOC_G_EXT_CTRLS)] = "VIDIOC_G_EXT_CTRLS",
  237. [_IOC_NR(VIDIOC_S_EXT_CTRLS)] = "VIDIOC_S_EXT_CTRLS",
  238. [_IOC_NR(VIDIOC_TRY_EXT_CTRLS)] = "VIDIOC_TRY_EXT_CTRLS",
  239. #if 1
  240. [_IOC_NR(VIDIOC_ENUM_FRAMESIZES)] = "VIDIOC_ENUM_FRAMESIZES",
  241. [_IOC_NR(VIDIOC_ENUM_FRAMEINTERVALS)] = "VIDIOC_ENUM_FRAMEINTERVALS",
  242. [_IOC_NR(VIDIOC_G_ENC_INDEX)] = "VIDIOC_G_ENC_INDEX",
  243. [_IOC_NR(VIDIOC_ENCODER_CMD)] = "VIDIOC_ENCODER_CMD",
  244. [_IOC_NR(VIDIOC_TRY_ENCODER_CMD)] = "VIDIOC_TRY_ENCODER_CMD",
  245. [_IOC_NR(VIDIOC_DBG_S_REGISTER)] = "VIDIOC_DBG_S_REGISTER",
  246. [_IOC_NR(VIDIOC_DBG_G_REGISTER)] = "VIDIOC_DBG_G_REGISTER",
  247. [_IOC_NR(VIDIOC_G_CHIP_IDENT)] = "VIDIOC_G_CHIP_IDENT",
  248. [_IOC_NR(VIDIOC_S_HW_FREQ_SEEK)] = "VIDIOC_S_HW_FREQ_SEEK",
  249. #endif
  250. };
  251. #define V4L2_IOCTLS ARRAY_SIZE(v4l2_ioctls)
  252. static const char *v4l2_int_ioctls[] = {
  253. #ifdef CONFIG_VIDEO_V4L1_COMPAT
  254. [_IOC_NR(DECODER_GET_CAPABILITIES)] = "DECODER_GET_CAPABILITIES",
  255. [_IOC_NR(DECODER_GET_STATUS)] = "DECODER_GET_STATUS",
  256. [_IOC_NR(DECODER_SET_NORM)] = "DECODER_SET_NORM",
  257. [_IOC_NR(DECODER_SET_INPUT)] = "DECODER_SET_INPUT",
  258. [_IOC_NR(DECODER_SET_OUTPUT)] = "DECODER_SET_OUTPUT",
  259. [_IOC_NR(DECODER_ENABLE_OUTPUT)] = "DECODER_ENABLE_OUTPUT",
  260. [_IOC_NR(DECODER_SET_PICTURE)] = "DECODER_SET_PICTURE",
  261. [_IOC_NR(DECODER_SET_GPIO)] = "DECODER_SET_GPIO",
  262. [_IOC_NR(DECODER_INIT)] = "DECODER_INIT",
  263. [_IOC_NR(DECODER_SET_VBI_BYPASS)] = "DECODER_SET_VBI_BYPASS",
  264. [_IOC_NR(DECODER_DUMP)] = "DECODER_DUMP",
  265. #endif
  266. [_IOC_NR(AUDC_SET_RADIO)] = "AUDC_SET_RADIO",
  267. [_IOC_NR(TUNER_SET_TYPE_ADDR)] = "TUNER_SET_TYPE_ADDR",
  268. [_IOC_NR(TUNER_SET_STANDBY)] = "TUNER_SET_STANDBY",
  269. [_IOC_NR(TUNER_SET_CONFIG)] = "TUNER_SET_CONFIG",
  270. [_IOC_NR(VIDIOC_INT_S_TUNER_MODE)] = "VIDIOC_INT_S_TUNER_MODE",
  271. [_IOC_NR(VIDIOC_INT_RESET)] = "VIDIOC_INT_RESET",
  272. [_IOC_NR(VIDIOC_INT_AUDIO_CLOCK_FREQ)] = "VIDIOC_INT_AUDIO_CLOCK_FREQ",
  273. [_IOC_NR(VIDIOC_INT_DECODE_VBI_LINE)] = "VIDIOC_INT_DECODE_VBI_LINE",
  274. [_IOC_NR(VIDIOC_INT_S_VBI_DATA)] = "VIDIOC_INT_S_VBI_DATA",
  275. [_IOC_NR(VIDIOC_INT_G_VBI_DATA)] = "VIDIOC_INT_G_VBI_DATA",
  276. [_IOC_NR(VIDIOC_INT_I2S_CLOCK_FREQ)] = "VIDIOC_INT_I2S_CLOCK_FREQ",
  277. [_IOC_NR(VIDIOC_INT_S_STANDBY)] = "VIDIOC_INT_S_STANDBY",
  278. [_IOC_NR(VIDIOC_INT_S_AUDIO_ROUTING)] = "VIDIOC_INT_S_AUDIO_ROUTING",
  279. [_IOC_NR(VIDIOC_INT_G_AUDIO_ROUTING)] = "VIDIOC_INT_G_AUDIO_ROUTING",
  280. [_IOC_NR(VIDIOC_INT_S_VIDEO_ROUTING)] = "VIDIOC_INT_S_VIDEO_ROUTING",
  281. [_IOC_NR(VIDIOC_INT_G_VIDEO_ROUTING)] = "VIDIOC_INT_G_VIDEO_ROUTING",
  282. [_IOC_NR(VIDIOC_INT_S_CRYSTAL_FREQ)] = "VIDIOC_INT_S_CRYSTAL_FREQ",
  283. [_IOC_NR(VIDIOC_INT_INIT)] = "VIDIOC_INT_INIT",
  284. [_IOC_NR(VIDIOC_INT_G_STD_OUTPUT)] = "VIDIOC_INT_G_STD_OUTPUT",
  285. [_IOC_NR(VIDIOC_INT_S_STD_OUTPUT)] = "VIDIOC_INT_S_STD_OUTPUT",
  286. };
  287. #define V4L2_INT_IOCTLS ARRAY_SIZE(v4l2_int_ioctls)
  288. /* Common ioctl debug function. This function can be used by
  289. external ioctl messages as well as internal V4L ioctl */
  290. void v4l_printk_ioctl(unsigned int cmd)
  291. {
  292. char *dir, *type;
  293. switch (_IOC_TYPE(cmd)) {
  294. case 'd':
  295. if (_IOC_NR(cmd) >= V4L2_INT_IOCTLS) {
  296. type = "v4l2_int";
  297. break;
  298. }
  299. printk("%s", v4l2_int_ioctls[_IOC_NR(cmd)]);
  300. return;
  301. #ifdef CONFIG_VIDEO_V4L1_COMPAT
  302. case 'v':
  303. if (_IOC_NR(cmd) >= V4L1_IOCTLS) {
  304. type = "v4l1";
  305. break;
  306. }
  307. printk("%s", v4l1_ioctls[_IOC_NR(cmd)]);
  308. return;
  309. #endif
  310. case 'V':
  311. if (_IOC_NR(cmd) >= V4L2_IOCTLS) {
  312. type = "v4l2";
  313. break;
  314. }
  315. printk("%s", v4l2_ioctls[_IOC_NR(cmd)]);
  316. return;
  317. default:
  318. type = "unknown";
  319. }
  320. switch (_IOC_DIR(cmd)) {
  321. case _IOC_NONE: dir = "--"; break;
  322. case _IOC_READ: dir = "r-"; break;
  323. case _IOC_WRITE: dir = "-w"; break;
  324. case _IOC_READ | _IOC_WRITE: dir = "rw"; break;
  325. default: dir = "*ERR*"; break;
  326. }
  327. printk("%s ioctl '%c', dir=%s, #%d (0x%08x)",
  328. type, _IOC_TYPE(cmd), dir, _IOC_NR(cmd), cmd);
  329. }
  330. EXPORT_SYMBOL(v4l_printk_ioctl);
  331. /*
  332. * helper function -- handles userspace copying for ioctl arguments
  333. */
  334. #ifdef __OLD_VIDIOC_
  335. static unsigned int
  336. video_fix_command(unsigned int cmd)
  337. {
  338. switch (cmd) {
  339. case VIDIOC_OVERLAY_OLD:
  340. cmd = VIDIOC_OVERLAY;
  341. break;
  342. case VIDIOC_S_PARM_OLD:
  343. cmd = VIDIOC_S_PARM;
  344. break;
  345. case VIDIOC_S_CTRL_OLD:
  346. cmd = VIDIOC_S_CTRL;
  347. break;
  348. case VIDIOC_G_AUDIO_OLD:
  349. cmd = VIDIOC_G_AUDIO;
  350. break;
  351. case VIDIOC_G_AUDOUT_OLD:
  352. cmd = VIDIOC_G_AUDOUT;
  353. break;
  354. case VIDIOC_CROPCAP_OLD:
  355. cmd = VIDIOC_CROPCAP;
  356. break;
  357. }
  358. return cmd;
  359. }
  360. #endif
  361. /*
  362. * Obsolete usercopy function - Should be removed soon
  363. */
  364. int
  365. video_usercopy(struct inode *inode, struct file *file,
  366. unsigned int cmd, unsigned long arg,
  367. int (*func)(struct inode *inode, struct file *file,
  368. unsigned int cmd, void *arg))
  369. {
  370. char sbuf[128];
  371. void *mbuf = NULL;
  372. void *parg = NULL;
  373. int err = -EINVAL;
  374. int is_ext_ctrl;
  375. size_t ctrls_size = 0;
  376. void __user *user_ptr = NULL;
  377. #ifdef __OLD_VIDIOC_
  378. cmd = video_fix_command(cmd);
  379. #endif
  380. is_ext_ctrl = (cmd == VIDIOC_S_EXT_CTRLS || cmd == VIDIOC_G_EXT_CTRLS ||
  381. cmd == VIDIOC_TRY_EXT_CTRLS);
  382. /* Copy arguments into temp kernel buffer */
  383. switch (_IOC_DIR(cmd)) {
  384. case _IOC_NONE:
  385. parg = NULL;
  386. break;
  387. case _IOC_READ:
  388. case _IOC_WRITE:
  389. case (_IOC_WRITE | _IOC_READ):
  390. if (_IOC_SIZE(cmd) <= sizeof(sbuf)) {
  391. parg = sbuf;
  392. } else {
  393. /* too big to allocate from stack */
  394. mbuf = kmalloc(_IOC_SIZE(cmd), GFP_KERNEL);
  395. if (NULL == mbuf)
  396. return -ENOMEM;
  397. parg = mbuf;
  398. }
  399. err = -EFAULT;
  400. if (_IOC_DIR(cmd) & _IOC_WRITE)
  401. if (copy_from_user(parg, (void __user *)arg, _IOC_SIZE(cmd)))
  402. goto out;
  403. break;
  404. }
  405. if (is_ext_ctrl) {
  406. struct v4l2_ext_controls *p = parg;
  407. /* In case of an error, tell the caller that it wasn't
  408. a specific control that caused it. */
  409. p->error_idx = p->count;
  410. user_ptr = (void __user *)p->controls;
  411. if (p->count) {
  412. ctrls_size = sizeof(struct v4l2_ext_control) * p->count;
  413. /* Note: v4l2_ext_controls fits in sbuf[] so mbuf is still NULL. */
  414. mbuf = kmalloc(ctrls_size, GFP_KERNEL);
  415. err = -ENOMEM;
  416. if (NULL == mbuf)
  417. goto out_ext_ctrl;
  418. err = -EFAULT;
  419. if (copy_from_user(mbuf, user_ptr, ctrls_size))
  420. goto out_ext_ctrl;
  421. p->controls = mbuf;
  422. }
  423. }
  424. /* call driver */
  425. err = func(inode, file, cmd, parg);
  426. if (err == -ENOIOCTLCMD)
  427. err = -EINVAL;
  428. if (is_ext_ctrl) {
  429. struct v4l2_ext_controls *p = parg;
  430. p->controls = (void *)user_ptr;
  431. if (p->count && err == 0 && copy_to_user(user_ptr, mbuf, ctrls_size))
  432. err = -EFAULT;
  433. goto out_ext_ctrl;
  434. }
  435. if (err < 0)
  436. goto out;
  437. out_ext_ctrl:
  438. /* Copy results into user buffer */
  439. switch (_IOC_DIR(cmd)) {
  440. case _IOC_READ:
  441. case (_IOC_WRITE | _IOC_READ):
  442. if (copy_to_user((void __user *)arg, parg, _IOC_SIZE(cmd)))
  443. err = -EFAULT;
  444. break;
  445. }
  446. out:
  447. kfree(mbuf);
  448. return err;
  449. }
  450. EXPORT_SYMBOL(video_usercopy);
  451. static void dbgbuf(unsigned int cmd, struct video_device *vfd,
  452. struct v4l2_buffer *p)
  453. {
  454. struct v4l2_timecode *tc = &p->timecode;
  455. dbgarg(cmd, "%02ld:%02d:%02d.%08ld index=%d, type=%s, "
  456. "bytesused=%d, flags=0x%08d, "
  457. "field=%0d, sequence=%d, memory=%s, offset/userptr=0x%08lx, length=%d\n",
  458. p->timestamp.tv_sec / 3600,
  459. (int)(p->timestamp.tv_sec / 60) % 60,
  460. (int)(p->timestamp.tv_sec % 60),
  461. (long)p->timestamp.tv_usec,
  462. p->index,
  463. prt_names(p->type, v4l2_type_names),
  464. p->bytesused, p->flags,
  465. p->field, p->sequence,
  466. prt_names(p->memory, v4l2_memory_names),
  467. p->m.userptr, p->length);
  468. dbgarg2("timecode=%02d:%02d:%02d type=%d, "
  469. "flags=0x%08d, frames=%d, userbits=0x%08x\n",
  470. tc->hours, tc->minutes, tc->seconds,
  471. tc->type, tc->flags, tc->frames, *(__u32 *)tc->userbits);
  472. }
  473. static inline void dbgrect(struct video_device *vfd, char *s,
  474. struct v4l2_rect *r)
  475. {
  476. dbgarg2("%sRect start at %dx%d, size=%dx%d\n", s, r->left, r->top,
  477. r->width, r->height);
  478. };
  479. static inline void v4l_print_pix_fmt(struct video_device *vfd,
  480. struct v4l2_pix_format *fmt)
  481. {
  482. dbgarg2("width=%d, height=%d, format=%c%c%c%c, field=%s, "
  483. "bytesperline=%d sizeimage=%d, colorspace=%d\n",
  484. fmt->width, fmt->height,
  485. (fmt->pixelformat & 0xff),
  486. (fmt->pixelformat >> 8) & 0xff,
  487. (fmt->pixelformat >> 16) & 0xff,
  488. (fmt->pixelformat >> 24) & 0xff,
  489. prt_names(fmt->field, v4l2_field_names),
  490. fmt->bytesperline, fmt->sizeimage, fmt->colorspace);
  491. };
  492. static inline void v4l_print_ext_ctrls(unsigned int cmd,
  493. struct video_device *vfd, struct v4l2_ext_controls *c, int show_vals)
  494. {
  495. __u32 i;
  496. if (!(vfd->debug & V4L2_DEBUG_IOCTL_ARG))
  497. return;
  498. dbgarg(cmd, "");
  499. printk(KERN_CONT "class=0x%x", c->ctrl_class);
  500. for (i = 0; i < c->count; i++) {
  501. if (show_vals)
  502. printk(KERN_CONT " id/val=0x%x/0x%x",
  503. c->controls[i].id, c->controls[i].value);
  504. else
  505. printk(KERN_CONT " id=0x%x", c->controls[i].id);
  506. }
  507. printk(KERN_CONT "\n");
  508. };
  509. static inline int check_ext_ctrls(struct v4l2_ext_controls *c, int allow_priv)
  510. {
  511. __u32 i;
  512. /* zero the reserved fields */
  513. c->reserved[0] = c->reserved[1] = 0;
  514. for (i = 0; i < c->count; i++) {
  515. c->controls[i].reserved2[0] = 0;
  516. c->controls[i].reserved2[1] = 0;
  517. }
  518. /* V4L2_CID_PRIVATE_BASE cannot be used as control class
  519. when using extended controls.
  520. Only when passed in through VIDIOC_G_CTRL and VIDIOC_S_CTRL
  521. is it allowed for backwards compatibility.
  522. */
  523. if (!allow_priv && c->ctrl_class == V4L2_CID_PRIVATE_BASE)
  524. return 0;
  525. /* Check that all controls are from the same control class. */
  526. for (i = 0; i < c->count; i++) {
  527. if (V4L2_CTRL_ID2CLASS(c->controls[i].id) != c->ctrl_class) {
  528. c->error_idx = i;
  529. return 0;
  530. }
  531. }
  532. return 1;
  533. }
  534. static int check_fmt(const struct v4l2_ioctl_ops *ops, enum v4l2_buf_type type)
  535. {
  536. if (ops == NULL)
  537. return -EINVAL;
  538. switch (type) {
  539. case V4L2_BUF_TYPE_VIDEO_CAPTURE:
  540. if (ops->vidioc_try_fmt_vid_cap)
  541. return 0;
  542. break;
  543. case V4L2_BUF_TYPE_VIDEO_OVERLAY:
  544. if (ops->vidioc_try_fmt_vid_overlay)
  545. return 0;
  546. break;
  547. case V4L2_BUF_TYPE_VIDEO_OUTPUT:
  548. if (ops->vidioc_try_fmt_vid_out)
  549. return 0;
  550. break;
  551. case V4L2_BUF_TYPE_VIDEO_OUTPUT_OVERLAY:
  552. if (ops->vidioc_try_fmt_vid_out_overlay)
  553. return 0;
  554. break;
  555. case V4L2_BUF_TYPE_VBI_CAPTURE:
  556. if (ops->vidioc_try_fmt_vbi_cap)
  557. return 0;
  558. break;
  559. case V4L2_BUF_TYPE_VBI_OUTPUT:
  560. if (ops->vidioc_try_fmt_vbi_out)
  561. return 0;
  562. break;
  563. case V4L2_BUF_TYPE_SLICED_VBI_CAPTURE:
  564. if (ops->vidioc_try_fmt_sliced_vbi_cap)
  565. return 0;
  566. break;
  567. case V4L2_BUF_TYPE_SLICED_VBI_OUTPUT:
  568. if (ops->vidioc_try_fmt_sliced_vbi_out)
  569. return 0;
  570. break;
  571. case V4L2_BUF_TYPE_PRIVATE:
  572. if (ops->vidioc_try_fmt_type_private)
  573. return 0;
  574. break;
  575. }
  576. return -EINVAL;
  577. }
  578. static int __video_do_ioctl(struct inode *inode, struct file *file,
  579. unsigned int cmd, void *arg)
  580. {
  581. struct video_device *vfd = video_devdata(file);
  582. const struct v4l2_ioctl_ops *ops = vfd->ioctl_ops;
  583. void *fh = file->private_data;
  584. int ret = -EINVAL;
  585. if ((vfd->debug & V4L2_DEBUG_IOCTL) &&
  586. !(vfd->debug & V4L2_DEBUG_IOCTL_ARG)) {
  587. v4l_print_ioctl(vfd->name, cmd);
  588. printk(KERN_CONT "\n");
  589. }
  590. if (ops == NULL) {
  591. printk(KERN_WARNING "videodev: \"%s\" has no ioctl_ops.\n",
  592. vfd->name);
  593. return -EINVAL;
  594. }
  595. #ifdef CONFIG_VIDEO_V4L1_COMPAT
  596. /***********************************************************
  597. Handles calls to the obsoleted V4L1 API
  598. Due to the nature of VIDIOCGMBUF, each driver that supports
  599. V4L1 should implement its own handler for this ioctl.
  600. ***********************************************************/
  601. /* --- streaming capture ------------------------------------- */
  602. if (cmd == VIDIOCGMBUF) {
  603. struct video_mbuf *p = arg;
  604. memset(p, 0, sizeof(*p));
  605. if (!ops->vidiocgmbuf)
  606. return ret;
  607. ret = ops->vidiocgmbuf(file, fh, p);
  608. if (!ret)
  609. dbgarg(cmd, "size=%d, frames=%d, offsets=0x%08lx\n",
  610. p->size, p->frames,
  611. (unsigned long)p->offsets);
  612. return ret;
  613. }
  614. /********************************************************
  615. All other V4L1 calls are handled by v4l1_compat module.
  616. Those calls will be translated into V4L2 calls, and
  617. __video_do_ioctl will be called again, with one or more
  618. V4L2 ioctls.
  619. ********************************************************/
  620. if (_IOC_TYPE(cmd) == 'v' && _IOC_NR(cmd) < BASE_VIDIOCPRIVATE)
  621. return v4l_compat_translate_ioctl(inode, file, cmd, arg,
  622. __video_do_ioctl);
  623. #endif
  624. switch (cmd) {
  625. /* --- capabilities ------------------------------------------ */
  626. case VIDIOC_QUERYCAP:
  627. {
  628. struct v4l2_capability *cap = (struct v4l2_capability *)arg;
  629. memset(cap, 0, sizeof(*cap));
  630. if (!ops->vidioc_querycap)
  631. break;
  632. ret = ops->vidioc_querycap(file, fh, cap);
  633. if (!ret)
  634. dbgarg(cmd, "driver=%s, card=%s, bus=%s, "
  635. "version=0x%08x, "
  636. "capabilities=0x%08x\n",
  637. cap->driver, cap->card, cap->bus_info,
  638. cap->version,
  639. cap->capabilities);
  640. break;
  641. }
  642. /* --- priority ------------------------------------------ */
  643. case VIDIOC_G_PRIORITY:
  644. {
  645. enum v4l2_priority *p = arg;
  646. if (!ops->vidioc_g_priority)
  647. break;
  648. ret = ops->vidioc_g_priority(file, fh, p);
  649. if (!ret)
  650. dbgarg(cmd, "priority is %d\n", *p);
  651. break;
  652. }
  653. case VIDIOC_S_PRIORITY:
  654. {
  655. enum v4l2_priority *p = arg;
  656. if (!ops->vidioc_s_priority)
  657. break;
  658. dbgarg(cmd, "setting priority to %d\n", *p);
  659. ret = ops->vidioc_s_priority(file, fh, *p);
  660. break;
  661. }
  662. /* --- capture ioctls ---------------------------------------- */
  663. case VIDIOC_ENUM_FMT:
  664. {
  665. struct v4l2_fmtdesc *f = arg;
  666. enum v4l2_buf_type type;
  667. unsigned int index;
  668. index = f->index;
  669. type = f->type;
  670. memset(f, 0, sizeof(*f));
  671. f->index = index;
  672. f->type = type;
  673. switch (type) {
  674. case V4L2_BUF_TYPE_VIDEO_CAPTURE:
  675. if (ops->vidioc_enum_fmt_vid_cap)
  676. ret = ops->vidioc_enum_fmt_vid_cap(file, fh, f);
  677. break;
  678. case V4L2_BUF_TYPE_VIDEO_OVERLAY:
  679. if (ops->vidioc_enum_fmt_vid_overlay)
  680. ret = ops->vidioc_enum_fmt_vid_overlay(file,
  681. fh, f);
  682. break;
  683. #if 1
  684. /* V4L2_BUF_TYPE_VBI_CAPTURE should not support VIDIOC_ENUM_FMT
  685. * according to the spec. The bttv and saa7134 drivers support
  686. * it though, so just warn that this is deprecated and will be
  687. * removed in the near future. */
  688. case V4L2_BUF_TYPE_VBI_CAPTURE:
  689. if (ops->vidioc_enum_fmt_vbi_cap) {
  690. printk(KERN_WARNING "vidioc_enum_fmt_vbi_cap will be removed in 2.6.28!\n");
  691. ret = ops->vidioc_enum_fmt_vbi_cap(file, fh, f);
  692. }
  693. break;
  694. #endif
  695. case V4L2_BUF_TYPE_VIDEO_OUTPUT:
  696. if (ops->vidioc_enum_fmt_vid_out)
  697. ret = ops->vidioc_enum_fmt_vid_out(file, fh, f);
  698. break;
  699. case V4L2_BUF_TYPE_PRIVATE:
  700. if (ops->vidioc_enum_fmt_type_private)
  701. ret = ops->vidioc_enum_fmt_type_private(file,
  702. fh, f);
  703. break;
  704. default:
  705. break;
  706. }
  707. if (!ret)
  708. dbgarg(cmd, "index=%d, type=%d, flags=%d, "
  709. "pixelformat=%c%c%c%c, description='%s'\n",
  710. f->index, f->type, f->flags,
  711. (f->pixelformat & 0xff),
  712. (f->pixelformat >> 8) & 0xff,
  713. (f->pixelformat >> 16) & 0xff,
  714. (f->pixelformat >> 24) & 0xff,
  715. f->description);
  716. break;
  717. }
  718. case VIDIOC_G_FMT:
  719. {
  720. struct v4l2_format *f = (struct v4l2_format *)arg;
  721. memset(f->fmt.raw_data, 0, sizeof(f->fmt.raw_data));
  722. /* FIXME: Should be one dump per type */
  723. dbgarg(cmd, "type=%s\n", prt_names(f->type, v4l2_type_names));
  724. switch (f->type) {
  725. case V4L2_BUF_TYPE_VIDEO_CAPTURE:
  726. if (ops->vidioc_g_fmt_vid_cap)
  727. ret = ops->vidioc_g_fmt_vid_cap(file, fh, f);
  728. if (!ret)
  729. v4l_print_pix_fmt(vfd, &f->fmt.pix);
  730. break;
  731. case V4L2_BUF_TYPE_VIDEO_OVERLAY:
  732. if (ops->vidioc_g_fmt_vid_overlay)
  733. ret = ops->vidioc_g_fmt_vid_overlay(file,
  734. fh, f);
  735. break;
  736. case V4L2_BUF_TYPE_VIDEO_OUTPUT:
  737. if (ops->vidioc_g_fmt_vid_out)
  738. ret = ops->vidioc_g_fmt_vid_out(file, fh, f);
  739. if (!ret)
  740. v4l_print_pix_fmt(vfd, &f->fmt.pix);
  741. break;
  742. case V4L2_BUF_TYPE_VIDEO_OUTPUT_OVERLAY:
  743. if (ops->vidioc_g_fmt_vid_out_overlay)
  744. ret = ops->vidioc_g_fmt_vid_out_overlay(file,
  745. fh, f);
  746. break;
  747. case V4L2_BUF_TYPE_VBI_CAPTURE:
  748. if (ops->vidioc_g_fmt_vbi_cap)
  749. ret = ops->vidioc_g_fmt_vbi_cap(file, fh, f);
  750. break;
  751. case V4L2_BUF_TYPE_VBI_OUTPUT:
  752. if (ops->vidioc_g_fmt_vbi_out)
  753. ret = ops->vidioc_g_fmt_vbi_out(file, fh, f);
  754. break;
  755. case V4L2_BUF_TYPE_SLICED_VBI_CAPTURE:
  756. if (ops->vidioc_g_fmt_sliced_vbi_cap)
  757. ret = ops->vidioc_g_fmt_sliced_vbi_cap(file,
  758. fh, f);
  759. break;
  760. case V4L2_BUF_TYPE_SLICED_VBI_OUTPUT:
  761. if (ops->vidioc_g_fmt_sliced_vbi_out)
  762. ret = ops->vidioc_g_fmt_sliced_vbi_out(file,
  763. fh, f);
  764. break;
  765. case V4L2_BUF_TYPE_PRIVATE:
  766. if (ops->vidioc_g_fmt_type_private)
  767. ret = ops->vidioc_g_fmt_type_private(file,
  768. fh, f);
  769. break;
  770. }
  771. break;
  772. }
  773. case VIDIOC_S_FMT:
  774. {
  775. struct v4l2_format *f = (struct v4l2_format *)arg;
  776. /* FIXME: Should be one dump per type */
  777. dbgarg(cmd, "type=%s\n", prt_names(f->type, v4l2_type_names));
  778. switch (f->type) {
  779. case V4L2_BUF_TYPE_VIDEO_CAPTURE:
  780. v4l_print_pix_fmt(vfd, &f->fmt.pix);
  781. if (ops->vidioc_s_fmt_vid_cap)
  782. ret = ops->vidioc_s_fmt_vid_cap(file, fh, f);
  783. break;
  784. case V4L2_BUF_TYPE_VIDEO_OVERLAY:
  785. if (ops->vidioc_s_fmt_vid_overlay)
  786. ret = ops->vidioc_s_fmt_vid_overlay(file,
  787. fh, f);
  788. break;
  789. case V4L2_BUF_TYPE_VIDEO_OUTPUT:
  790. v4l_print_pix_fmt(vfd, &f->fmt.pix);
  791. if (ops->vidioc_s_fmt_vid_out)
  792. ret = ops->vidioc_s_fmt_vid_out(file, fh, f);
  793. break;
  794. case V4L2_BUF_TYPE_VIDEO_OUTPUT_OVERLAY:
  795. if (ops->vidioc_s_fmt_vid_out_overlay)
  796. ret = ops->vidioc_s_fmt_vid_out_overlay(file,
  797. fh, f);
  798. break;
  799. case V4L2_BUF_TYPE_VBI_CAPTURE:
  800. if (ops->vidioc_s_fmt_vbi_cap)
  801. ret = ops->vidioc_s_fmt_vbi_cap(file, fh, f);
  802. break;
  803. case V4L2_BUF_TYPE_VBI_OUTPUT:
  804. if (ops->vidioc_s_fmt_vbi_out)
  805. ret = ops->vidioc_s_fmt_vbi_out(file, fh, f);
  806. break;
  807. case V4L2_BUF_TYPE_SLICED_VBI_CAPTURE:
  808. if (ops->vidioc_s_fmt_sliced_vbi_cap)
  809. ret = ops->vidioc_s_fmt_sliced_vbi_cap(file,
  810. fh, f);
  811. break;
  812. case V4L2_BUF_TYPE_SLICED_VBI_OUTPUT:
  813. if (ops->vidioc_s_fmt_sliced_vbi_out)
  814. ret = ops->vidioc_s_fmt_sliced_vbi_out(file,
  815. fh, f);
  816. break;
  817. case V4L2_BUF_TYPE_PRIVATE:
  818. if (ops->vidioc_s_fmt_type_private)
  819. ret = ops->vidioc_s_fmt_type_private(file,
  820. fh, f);
  821. break;
  822. }
  823. break;
  824. }
  825. case VIDIOC_TRY_FMT:
  826. {
  827. struct v4l2_format *f = (struct v4l2_format *)arg;
  828. /* FIXME: Should be one dump per type */
  829. dbgarg(cmd, "type=%s\n", prt_names(f->type,
  830. v4l2_type_names));
  831. switch (f->type) {
  832. case V4L2_BUF_TYPE_VIDEO_CAPTURE:
  833. if (ops->vidioc_try_fmt_vid_cap)
  834. ret = ops->vidioc_try_fmt_vid_cap(file, fh, f);
  835. if (!ret)
  836. v4l_print_pix_fmt(vfd, &f->fmt.pix);
  837. break;
  838. case V4L2_BUF_TYPE_VIDEO_OVERLAY:
  839. if (ops->vidioc_try_fmt_vid_overlay)
  840. ret = ops->vidioc_try_fmt_vid_overlay(file,
  841. fh, f);
  842. break;
  843. case V4L2_BUF_TYPE_VIDEO_OUTPUT:
  844. if (ops->vidioc_try_fmt_vid_out)
  845. ret = ops->vidioc_try_fmt_vid_out(file, fh, f);
  846. if (!ret)
  847. v4l_print_pix_fmt(vfd, &f->fmt.pix);
  848. break;
  849. case V4L2_BUF_TYPE_VIDEO_OUTPUT_OVERLAY:
  850. if (ops->vidioc_try_fmt_vid_out_overlay)
  851. ret = ops->vidioc_try_fmt_vid_out_overlay(file,
  852. fh, f);
  853. break;
  854. case V4L2_BUF_TYPE_VBI_CAPTURE:
  855. if (ops->vidioc_try_fmt_vbi_cap)
  856. ret = ops->vidioc_try_fmt_vbi_cap(file, fh, f);
  857. break;
  858. case V4L2_BUF_TYPE_VBI_OUTPUT:
  859. if (ops->vidioc_try_fmt_vbi_out)
  860. ret = ops->vidioc_try_fmt_vbi_out(file, fh, f);
  861. break;
  862. case V4L2_BUF_TYPE_SLICED_VBI_CAPTURE:
  863. if (ops->vidioc_try_fmt_sliced_vbi_cap)
  864. ret = ops->vidioc_try_fmt_sliced_vbi_cap(file,
  865. fh, f);
  866. break;
  867. case V4L2_BUF_TYPE_SLICED_VBI_OUTPUT:
  868. if (ops->vidioc_try_fmt_sliced_vbi_out)
  869. ret = ops->vidioc_try_fmt_sliced_vbi_out(file,
  870. fh, f);
  871. break;
  872. case V4L2_BUF_TYPE_PRIVATE:
  873. if (ops->vidioc_try_fmt_type_private)
  874. ret = ops->vidioc_try_fmt_type_private(file,
  875. fh, f);
  876. break;
  877. }
  878. break;
  879. }
  880. /* FIXME: Those buf reqs could be handled here,
  881. with some changes on videobuf to allow its header to be included at
  882. videodev2.h or being merged at videodev2.
  883. */
  884. case VIDIOC_REQBUFS:
  885. {
  886. struct v4l2_requestbuffers *p = arg;
  887. if (!ops->vidioc_reqbufs)
  888. break;
  889. ret = check_fmt(ops, p->type);
  890. if (ret)
  891. break;
  892. ret = ops->vidioc_reqbufs(file, fh, p);
  893. dbgarg(cmd, "count=%d, type=%s, memory=%s\n",
  894. p->count,
  895. prt_names(p->type, v4l2_type_names),
  896. prt_names(p->memory, v4l2_memory_names));
  897. break;
  898. }
  899. case VIDIOC_QUERYBUF:
  900. {
  901. struct v4l2_buffer *p = arg;
  902. if (!ops->vidioc_querybuf)
  903. break;
  904. ret = check_fmt(ops, p->type);
  905. if (ret)
  906. break;
  907. ret = ops->vidioc_querybuf(file, fh, p);
  908. if (!ret)
  909. dbgbuf(cmd, vfd, p);
  910. break;
  911. }
  912. case VIDIOC_QBUF:
  913. {
  914. struct v4l2_buffer *p = arg;
  915. if (!ops->vidioc_qbuf)
  916. break;
  917. ret = check_fmt(ops, p->type);
  918. if (ret)
  919. break;
  920. ret = ops->vidioc_qbuf(file, fh, p);
  921. if (!ret)
  922. dbgbuf(cmd, vfd, p);
  923. break;
  924. }
  925. case VIDIOC_DQBUF:
  926. {
  927. struct v4l2_buffer *p = arg;
  928. if (!ops->vidioc_dqbuf)
  929. break;
  930. ret = check_fmt(ops, p->type);
  931. if (ret)
  932. break;
  933. ret = ops->vidioc_dqbuf(file, fh, p);
  934. if (!ret)
  935. dbgbuf(cmd, vfd, p);
  936. break;
  937. }
  938. case VIDIOC_OVERLAY:
  939. {
  940. int *i = arg;
  941. if (!ops->vidioc_overlay)
  942. break;
  943. dbgarg(cmd, "value=%d\n", *i);
  944. ret = ops->vidioc_overlay(file, fh, *i);
  945. break;
  946. }
  947. case VIDIOC_G_FBUF:
  948. {
  949. struct v4l2_framebuffer *p = arg;
  950. if (!ops->vidioc_g_fbuf)
  951. break;
  952. ret = ops->vidioc_g_fbuf(file, fh, arg);
  953. if (!ret) {
  954. dbgarg(cmd, "capability=0x%x, flags=%d, base=0x%08lx\n",
  955. p->capability, p->flags,
  956. (unsigned long)p->base);
  957. v4l_print_pix_fmt(vfd, &p->fmt);
  958. }
  959. break;
  960. }
  961. case VIDIOC_S_FBUF:
  962. {
  963. struct v4l2_framebuffer *p = arg;
  964. if (!ops->vidioc_s_fbuf)
  965. break;
  966. dbgarg(cmd, "capability=0x%x, flags=%d, base=0x%08lx\n",
  967. p->capability, p->flags, (unsigned long)p->base);
  968. v4l_print_pix_fmt(vfd, &p->fmt);
  969. ret = ops->vidioc_s_fbuf(file, fh, arg);
  970. break;
  971. }
  972. case VIDIOC_STREAMON:
  973. {
  974. enum v4l2_buf_type i = *(int *)arg;
  975. if (!ops->vidioc_streamon)
  976. break;
  977. dbgarg(cmd, "type=%s\n", prt_names(i, v4l2_type_names));
  978. ret = ops->vidioc_streamon(file, fh, i);
  979. break;
  980. }
  981. case VIDIOC_STREAMOFF:
  982. {
  983. enum v4l2_buf_type i = *(int *)arg;
  984. if (!ops->vidioc_streamoff)
  985. break;
  986. dbgarg(cmd, "type=%s\n", prt_names(i, v4l2_type_names));
  987. ret = ops->vidioc_streamoff(file, fh, i);
  988. break;
  989. }
  990. /* ---------- tv norms ---------- */
  991. case VIDIOC_ENUMSTD:
  992. {
  993. struct v4l2_standard *p = arg;
  994. v4l2_std_id id = vfd->tvnorms, curr_id = 0;
  995. unsigned int index = p->index, i, j = 0;
  996. const char *descr = "";
  997. /* Return norm array in a canonical way */
  998. for (i = 0; i <= index && id; i++) {
  999. /* last std value in the standards array is 0, so this
  1000. while always ends there since (id & 0) == 0. */
  1001. while ((id & standards[j].std) != standards[j].std)
  1002. j++;
  1003. curr_id = standards[j].std;
  1004. descr = standards[j].descr;
  1005. j++;
  1006. if (curr_id == 0)
  1007. break;
  1008. if (curr_id != V4L2_STD_PAL &&
  1009. curr_id != V4L2_STD_SECAM &&
  1010. curr_id != V4L2_STD_NTSC)
  1011. id &= ~curr_id;
  1012. }
  1013. if (i <= index)
  1014. return -EINVAL;
  1015. v4l2_video_std_construct(p, curr_id, descr);
  1016. p->index = index;
  1017. dbgarg(cmd, "index=%d, id=0x%Lx, name=%s, fps=%d/%d, "
  1018. "framelines=%d\n", p->index,
  1019. (unsigned long long)p->id, p->name,
  1020. p->frameperiod.numerator,
  1021. p->frameperiod.denominator,
  1022. p->framelines);
  1023. ret = 0;
  1024. break;
  1025. }
  1026. case VIDIOC_G_STD:
  1027. {
  1028. v4l2_std_id *id = arg;
  1029. ret = 0;
  1030. /* Calls the specific handler */
  1031. if (ops->vidioc_g_std)
  1032. ret = ops->vidioc_g_std(file, fh, id);
  1033. else
  1034. *id = vfd->current_norm;
  1035. if (!ret)
  1036. dbgarg(cmd, "std=0x%08Lx\n", (long long unsigned)*id);
  1037. break;
  1038. }
  1039. case VIDIOC_S_STD:
  1040. {
  1041. v4l2_std_id *id = arg, norm;
  1042. dbgarg(cmd, "std=%08Lx\n", (long long unsigned)*id);
  1043. norm = (*id) & vfd->tvnorms;
  1044. if (vfd->tvnorms && !norm) /* Check if std is supported */
  1045. break;
  1046. /* Calls the specific handler */
  1047. if (ops->vidioc_s_std)
  1048. ret = ops->vidioc_s_std(file, fh, &norm);
  1049. else
  1050. ret = -EINVAL;
  1051. /* Updates standard information */
  1052. if (ret >= 0)
  1053. vfd->current_norm = norm;
  1054. break;
  1055. }
  1056. case VIDIOC_QUERYSTD:
  1057. {
  1058. v4l2_std_id *p = arg;
  1059. if (!ops->vidioc_querystd)
  1060. break;
  1061. ret = ops->vidioc_querystd(file, fh, arg);
  1062. if (!ret)
  1063. dbgarg(cmd, "detected std=%08Lx\n",
  1064. (unsigned long long)*p);
  1065. break;
  1066. }
  1067. /* ------ input switching ---------- */
  1068. /* FIXME: Inputs can be handled inside videodev2 */
  1069. case VIDIOC_ENUMINPUT:
  1070. {
  1071. struct v4l2_input *p = arg;
  1072. int i = p->index;
  1073. if (!ops->vidioc_enum_input)
  1074. break;
  1075. memset(p, 0, sizeof(*p));
  1076. p->index = i;
  1077. ret = ops->vidioc_enum_input(file, fh, p);
  1078. if (!ret)
  1079. dbgarg(cmd, "index=%d, name=%s, type=%d, "
  1080. "audioset=%d, "
  1081. "tuner=%d, std=%08Lx, status=%d\n",
  1082. p->index, p->name, p->type, p->audioset,
  1083. p->tuner,
  1084. (unsigned long long)p->std,
  1085. p->status);
  1086. break;
  1087. }
  1088. case VIDIOC_G_INPUT:
  1089. {
  1090. unsigned int *i = arg;
  1091. if (!ops->vidioc_g_input)
  1092. break;
  1093. ret = ops->vidioc_g_input(file, fh, i);
  1094. if (!ret)
  1095. dbgarg(cmd, "value=%d\n", *i);
  1096. break;
  1097. }
  1098. case VIDIOC_S_INPUT:
  1099. {
  1100. unsigned int *i = arg;
  1101. if (!ops->vidioc_s_input)
  1102. break;
  1103. dbgarg(cmd, "value=%d\n", *i);
  1104. ret = ops->vidioc_s_input(file, fh, *i);
  1105. break;
  1106. }
  1107. /* ------ output switching ---------- */
  1108. case VIDIOC_ENUMOUTPUT:
  1109. {
  1110. struct v4l2_output *p = arg;
  1111. int i = p->index;
  1112. if (!ops->vidioc_enum_output)
  1113. break;
  1114. memset(p, 0, sizeof(*p));
  1115. p->index = i;
  1116. ret = ops->vidioc_enum_output(file, fh, p);
  1117. if (!ret)
  1118. dbgarg(cmd, "index=%d, name=%s, type=%d, "
  1119. "audioset=0x%x, "
  1120. "modulator=%d, std=0x%08Lx\n",
  1121. p->index, p->name, p->type, p->audioset,
  1122. p->modulator, (unsigned long long)p->std);
  1123. break;
  1124. }
  1125. case VIDIOC_G_OUTPUT:
  1126. {
  1127. unsigned int *i = arg;
  1128. if (!ops->vidioc_g_output)
  1129. break;
  1130. ret = ops->vidioc_g_output(file, fh, i);
  1131. if (!ret)
  1132. dbgarg(cmd, "value=%d\n", *i);
  1133. break;
  1134. }
  1135. case VIDIOC_S_OUTPUT:
  1136. {
  1137. unsigned int *i = arg;
  1138. if (!ops->vidioc_s_output)
  1139. break;
  1140. dbgarg(cmd, "value=%d\n", *i);
  1141. ret = ops->vidioc_s_output(file, fh, *i);
  1142. break;
  1143. }
  1144. /* --- controls ---------------------------------------------- */
  1145. case VIDIOC_QUERYCTRL:
  1146. {
  1147. struct v4l2_queryctrl *p = arg;
  1148. if (!ops->vidioc_queryctrl)
  1149. break;
  1150. ret = ops->vidioc_queryctrl(file, fh, p);
  1151. if (!ret)
  1152. dbgarg(cmd, "id=0x%x, type=%d, name=%s, min/max=%d/%d, "
  1153. "step=%d, default=%d, flags=0x%08x\n",
  1154. p->id, p->type, p->name,
  1155. p->minimum, p->maximum,
  1156. p->step, p->default_value, p->flags);
  1157. else
  1158. dbgarg(cmd, "id=0x%x\n", p->id);
  1159. break;
  1160. }
  1161. case VIDIOC_G_CTRL:
  1162. {
  1163. struct v4l2_control *p = arg;
  1164. if (ops->vidioc_g_ctrl)
  1165. ret = ops->vidioc_g_ctrl(file, fh, p);
  1166. else if (ops->vidioc_g_ext_ctrls) {
  1167. struct v4l2_ext_controls ctrls;
  1168. struct v4l2_ext_control ctrl;
  1169. ctrls.ctrl_class = V4L2_CTRL_ID2CLASS(p->id);
  1170. ctrls.count = 1;
  1171. ctrls.controls = &ctrl;
  1172. ctrl.id = p->id;
  1173. ctrl.value = p->value;
  1174. if (check_ext_ctrls(&ctrls, 1)) {
  1175. ret = ops->vidioc_g_ext_ctrls(file, fh, &ctrls);
  1176. if (ret == 0)
  1177. p->value = ctrl.value;
  1178. }
  1179. } else
  1180. break;
  1181. if (!ret)
  1182. dbgarg(cmd, "id=0x%x, value=%d\n", p->id, p->value);
  1183. else
  1184. dbgarg(cmd, "id=0x%x\n", p->id);
  1185. break;
  1186. }
  1187. case VIDIOC_S_CTRL:
  1188. {
  1189. struct v4l2_control *p = arg;
  1190. struct v4l2_ext_controls ctrls;
  1191. struct v4l2_ext_control ctrl;
  1192. if (!ops->vidioc_s_ctrl && !ops->vidioc_s_ext_ctrls)
  1193. break;
  1194. dbgarg(cmd, "id=0x%x, value=%d\n", p->id, p->value);
  1195. if (ops->vidioc_s_ctrl) {
  1196. ret = ops->vidioc_s_ctrl(file, fh, p);
  1197. break;
  1198. }
  1199. if (!ops->vidioc_s_ext_ctrls)
  1200. break;
  1201. ctrls.ctrl_class = V4L2_CTRL_ID2CLASS(p->id);
  1202. ctrls.count = 1;
  1203. ctrls.controls = &ctrl;
  1204. ctrl.id = p->id;
  1205. ctrl.value = p->value;
  1206. if (check_ext_ctrls(&ctrls, 1))
  1207. ret = ops->vidioc_s_ext_ctrls(file, fh, &ctrls);
  1208. break;
  1209. }
  1210. case VIDIOC_G_EXT_CTRLS:
  1211. {
  1212. struct v4l2_ext_controls *p = arg;
  1213. p->error_idx = p->count;
  1214. if (!ops->vidioc_g_ext_ctrls)
  1215. break;
  1216. if (check_ext_ctrls(p, 0))
  1217. ret = ops->vidioc_g_ext_ctrls(file, fh, p);
  1218. v4l_print_ext_ctrls(cmd, vfd, p, !ret);
  1219. break;
  1220. }
  1221. case VIDIOC_S_EXT_CTRLS:
  1222. {
  1223. struct v4l2_ext_controls *p = arg;
  1224. p->error_idx = p->count;
  1225. if (!ops->vidioc_s_ext_ctrls)
  1226. break;
  1227. v4l_print_ext_ctrls(cmd, vfd, p, 1);
  1228. if (check_ext_ctrls(p, 0))
  1229. ret = ops->vidioc_s_ext_ctrls(file, fh, p);
  1230. break;
  1231. }
  1232. case VIDIOC_TRY_EXT_CTRLS:
  1233. {
  1234. struct v4l2_ext_controls *p = arg;
  1235. p->error_idx = p->count;
  1236. if (!ops->vidioc_try_ext_ctrls)
  1237. break;
  1238. v4l_print_ext_ctrls(cmd, vfd, p, 1);
  1239. if (check_ext_ctrls(p, 0))
  1240. ret = ops->vidioc_try_ext_ctrls(file, fh, p);
  1241. break;
  1242. }
  1243. case VIDIOC_QUERYMENU:
  1244. {
  1245. struct v4l2_querymenu *p = arg;
  1246. if (!ops->vidioc_querymenu)
  1247. break;
  1248. ret = ops->vidioc_querymenu(file, fh, p);
  1249. if (!ret)
  1250. dbgarg(cmd, "id=0x%x, index=%d, name=%s\n",
  1251. p->id, p->index, p->name);
  1252. else
  1253. dbgarg(cmd, "id=0x%x, index=%d\n",
  1254. p->id, p->index);
  1255. break;
  1256. }
  1257. /* --- audio ---------------------------------------------- */
  1258. case VIDIOC_ENUMAUDIO:
  1259. {
  1260. struct v4l2_audio *p = arg;
  1261. if (!ops->vidioc_enumaudio)
  1262. break;
  1263. ret = ops->vidioc_enumaudio(file, fh, p);
  1264. if (!ret)
  1265. dbgarg(cmd, "index=%d, name=%s, capability=0x%x, "
  1266. "mode=0x%x\n", p->index, p->name,
  1267. p->capability, p->mode);
  1268. else
  1269. dbgarg(cmd, "index=%d\n", p->index);
  1270. break;
  1271. }
  1272. case VIDIOC_G_AUDIO:
  1273. {
  1274. struct v4l2_audio *p = arg;
  1275. __u32 index = p->index;
  1276. if (!ops->vidioc_g_audio)
  1277. break;
  1278. memset(p, 0, sizeof(*p));
  1279. p->index = index;
  1280. ret = ops->vidioc_g_audio(file, fh, p);
  1281. if (!ret)
  1282. dbgarg(cmd, "index=%d, name=%s, capability=0x%x, "
  1283. "mode=0x%x\n", p->index,
  1284. p->name, p->capability, p->mode);
  1285. else
  1286. dbgarg(cmd, "index=%d\n", p->index);
  1287. break;
  1288. }
  1289. case VIDIOC_S_AUDIO:
  1290. {
  1291. struct v4l2_audio *p = arg;
  1292. if (!ops->vidioc_s_audio)
  1293. break;
  1294. dbgarg(cmd, "index=%d, name=%s, capability=0x%x, "
  1295. "mode=0x%x\n", p->index, p->name,
  1296. p->capability, p->mode);
  1297. ret = ops->vidioc_s_audio(file, fh, p);
  1298. break;
  1299. }
  1300. case VIDIOC_ENUMAUDOUT:
  1301. {
  1302. struct v4l2_audioout *p = arg;
  1303. if (!ops->vidioc_enumaudout)
  1304. break;
  1305. dbgarg(cmd, "Enum for index=%d\n", p->index);
  1306. ret = ops->vidioc_enumaudout(file, fh, p);
  1307. if (!ret)
  1308. dbgarg2("index=%d, name=%s, capability=%d, "
  1309. "mode=%d\n", p->index, p->name,
  1310. p->capability, p->mode);
  1311. break;
  1312. }
  1313. case VIDIOC_G_AUDOUT:
  1314. {
  1315. struct v4l2_audioout *p = arg;
  1316. if (!ops->vidioc_g_audout)
  1317. break;
  1318. dbgarg(cmd, "Enum for index=%d\n", p->index);
  1319. ret = ops->vidioc_g_audout(file, fh, p);
  1320. if (!ret)
  1321. dbgarg2("index=%d, name=%s, capability=%d, "
  1322. "mode=%d\n", p->index, p->name,
  1323. p->capability, p->mode);
  1324. break;
  1325. }
  1326. case VIDIOC_S_AUDOUT:
  1327. {
  1328. struct v4l2_audioout *p = arg;
  1329. if (!ops->vidioc_s_audout)
  1330. break;
  1331. dbgarg(cmd, "index=%d, name=%s, capability=%d, "
  1332. "mode=%d\n", p->index, p->name,
  1333. p->capability, p->mode);
  1334. ret = ops->vidioc_s_audout(file, fh, p);
  1335. break;
  1336. }
  1337. case VIDIOC_G_MODULATOR:
  1338. {
  1339. struct v4l2_modulator *p = arg;
  1340. if (!ops->vidioc_g_modulator)
  1341. break;
  1342. ret = ops->vidioc_g_modulator(file, fh, p);
  1343. if (!ret)
  1344. dbgarg(cmd, "index=%d, name=%s, "
  1345. "capability=%d, rangelow=%d,"
  1346. " rangehigh=%d, txsubchans=%d\n",
  1347. p->index, p->name, p->capability,
  1348. p->rangelow, p->rangehigh,
  1349. p->txsubchans);
  1350. break;
  1351. }
  1352. case VIDIOC_S_MODULATOR:
  1353. {
  1354. struct v4l2_modulator *p = arg;
  1355. if (!ops->vidioc_s_modulator)
  1356. break;
  1357. dbgarg(cmd, "index=%d, name=%s, capability=%d, "
  1358. "rangelow=%d, rangehigh=%d, txsubchans=%d\n",
  1359. p->index, p->name, p->capability, p->rangelow,
  1360. p->rangehigh, p->txsubchans);
  1361. ret = ops->vidioc_s_modulator(file, fh, p);
  1362. break;
  1363. }
  1364. case VIDIOC_G_CROP:
  1365. {
  1366. struct v4l2_crop *p = arg;
  1367. if (!ops->vidioc_g_crop)
  1368. break;
  1369. dbgarg(cmd, "type=%s\n", prt_names(p->type, v4l2_type_names));
  1370. ret = ops->vidioc_g_crop(file, fh, p);
  1371. if (!ret)
  1372. dbgrect(vfd, "", &p->c);
  1373. break;
  1374. }
  1375. case VIDIOC_S_CROP:
  1376. {
  1377. struct v4l2_crop *p = arg;
  1378. if (!ops->vidioc_s_crop)
  1379. break;
  1380. dbgarg(cmd, "type=%s\n", prt_names(p->type, v4l2_type_names));
  1381. dbgrect(vfd, "", &p->c);
  1382. ret = ops->vidioc_s_crop(file, fh, p);
  1383. break;
  1384. }
  1385. case VIDIOC_CROPCAP:
  1386. {
  1387. struct v4l2_cropcap *p = arg;
  1388. /*FIXME: Should also show v4l2_fract pixelaspect */
  1389. if (!ops->vidioc_cropcap)
  1390. break;
  1391. dbgarg(cmd, "type=%s\n", prt_names(p->type, v4l2_type_names));
  1392. ret = ops->vidioc_cropcap(file, fh, p);
  1393. if (!ret) {
  1394. dbgrect(vfd, "bounds ", &p->bounds);
  1395. dbgrect(vfd, "defrect ", &p->defrect);
  1396. }
  1397. break;
  1398. }
  1399. case VIDIOC_G_JPEGCOMP:
  1400. {
  1401. struct v4l2_jpegcompression *p = arg;
  1402. if (!ops->vidioc_g_jpegcomp)
  1403. break;
  1404. ret = ops->vidioc_g_jpegcomp(file, fh, p);
  1405. if (!ret)
  1406. dbgarg(cmd, "quality=%d, APPn=%d, "
  1407. "APP_len=%d, COM_len=%d, "
  1408. "jpeg_markers=%d\n",
  1409. p->quality, p->APPn, p->APP_len,
  1410. p->COM_len, p->jpeg_markers);
  1411. break;
  1412. }
  1413. case VIDIOC_S_JPEGCOMP:
  1414. {
  1415. struct v4l2_jpegcompression *p = arg;
  1416. if (!ops->vidioc_g_jpegcomp)
  1417. break;
  1418. dbgarg(cmd, "quality=%d, APPn=%d, APP_len=%d, "
  1419. "COM_len=%d, jpeg_markers=%d\n",
  1420. p->quality, p->APPn, p->APP_len,
  1421. p->COM_len, p->jpeg_markers);
  1422. ret = ops->vidioc_s_jpegcomp(file, fh, p);
  1423. break;
  1424. }
  1425. case VIDIOC_G_ENC_INDEX:
  1426. {
  1427. struct v4l2_enc_idx *p = arg;
  1428. if (!ops->vidioc_g_enc_index)
  1429. break;
  1430. ret = ops->vidioc_g_enc_index(file, fh, p);
  1431. if (!ret)
  1432. dbgarg(cmd, "entries=%d, entries_cap=%d\n",
  1433. p->entries, p->entries_cap);
  1434. break;
  1435. }
  1436. case VIDIOC_ENCODER_CMD:
  1437. {
  1438. struct v4l2_encoder_cmd *p = arg;
  1439. if (!ops->vidioc_encoder_cmd)
  1440. break;
  1441. memset(&p->raw, 0, sizeof(p->raw));
  1442. ret = ops->vidioc_encoder_cmd(file, fh, p);
  1443. if (!ret)
  1444. dbgarg(cmd, "cmd=%d, flags=%x\n", p->cmd, p->flags);
  1445. break;
  1446. }
  1447. case VIDIOC_TRY_ENCODER_CMD:
  1448. {
  1449. struct v4l2_encoder_cmd *p = arg;
  1450. if (!ops->vidioc_try_encoder_cmd)
  1451. break;
  1452. memset(&p->raw, 0, sizeof(p->raw));
  1453. ret = ops->vidioc_try_encoder_cmd(file, fh, p);
  1454. if (!ret)
  1455. dbgarg(cmd, "cmd=%d, flags=%x\n", p->cmd, p->flags);
  1456. break;
  1457. }
  1458. case VIDIOC_G_PARM:
  1459. {
  1460. struct v4l2_streamparm *p = arg;
  1461. __u32 type = p->type;
  1462. memset(p, 0, sizeof(*p));
  1463. p->type = type;
  1464. if (ops->vidioc_g_parm) {
  1465. ret = ops->vidioc_g_parm(file, fh, p);
  1466. } else {
  1467. struct v4l2_standard s;
  1468. if (p->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
  1469. return -EINVAL;
  1470. v4l2_video_std_construct(&s, vfd->current_norm,
  1471. v4l2_norm_to_name(vfd->current_norm));
  1472. p->parm.capture.timeperframe = s.frameperiod;
  1473. ret = 0;
  1474. }
  1475. dbgarg(cmd, "type=%d\n", p->type);
  1476. break;
  1477. }
  1478. case VIDIOC_S_PARM:
  1479. {
  1480. struct v4l2_streamparm *p = arg;
  1481. if (!ops->vidioc_s_parm)
  1482. break;
  1483. dbgarg(cmd, "type=%d\n", p->type);
  1484. ret = ops->vidioc_s_parm(file, fh, p);
  1485. break;
  1486. }
  1487. case VIDIOC_G_TUNER:
  1488. {
  1489. struct v4l2_tuner *p = arg;
  1490. __u32 index = p->index;
  1491. if (!ops->vidioc_g_tuner)
  1492. break;
  1493. memset(p, 0, sizeof(*p));
  1494. p->index = index;
  1495. ret = ops->vidioc_g_tuner(file, fh, p);
  1496. if (!ret)
  1497. dbgarg(cmd, "index=%d, name=%s, type=%d, "
  1498. "capability=0x%x, rangelow=%d, "
  1499. "rangehigh=%d, signal=%d, afc=%d, "
  1500. "rxsubchans=0x%x, audmode=%d\n",
  1501. p->index, p->name, p->type,
  1502. p->capability, p->rangelow,
  1503. p->rangehigh, p->signal, p->afc,
  1504. p->rxsubchans, p->audmode);
  1505. break;
  1506. }
  1507. case VIDIOC_S_TUNER:
  1508. {
  1509. struct v4l2_tuner *p = arg;
  1510. if (!ops->vidioc_s_tuner)
  1511. break;
  1512. dbgarg(cmd, "index=%d, name=%s, type=%d, "
  1513. "capability=0x%x, rangelow=%d, "
  1514. "rangehigh=%d, signal=%d, afc=%d, "
  1515. "rxsubchans=0x%x, audmode=%d\n",
  1516. p->index, p->name, p->type,
  1517. p->capability, p->rangelow,
  1518. p->rangehigh, p->signal, p->afc,
  1519. p->rxsubchans, p->audmode);
  1520. ret = ops->vidioc_s_tuner(file, fh, p);
  1521. break;
  1522. }
  1523. case VIDIOC_G_FREQUENCY:
  1524. {
  1525. struct v4l2_frequency *p = arg;
  1526. if (!ops->vidioc_g_frequency)
  1527. break;
  1528. memset(p->reserved, 0, sizeof(p->reserved));
  1529. ret = ops->vidioc_g_frequency(file, fh, p);
  1530. if (!ret)
  1531. dbgarg(cmd, "tuner=%d, type=%d, frequency=%d\n",
  1532. p->tuner, p->type, p->frequency);
  1533. break;
  1534. }
  1535. case VIDIOC_S_FREQUENCY:
  1536. {
  1537. struct v4l2_frequency *p = arg;
  1538. if (!ops->vidioc_s_frequency)
  1539. break;
  1540. dbgarg(cmd, "tuner=%d, type=%d, frequency=%d\n",
  1541. p->tuner, p->type, p->frequency);
  1542. ret = ops->vidioc_s_frequency(file, fh, p);
  1543. break;
  1544. }
  1545. case VIDIOC_G_SLICED_VBI_CAP:
  1546. {
  1547. struct v4l2_sliced_vbi_cap *p = arg;
  1548. __u32 type = p->type;
  1549. if (!ops->vidioc_g_sliced_vbi_cap)
  1550. break;
  1551. memset(p, 0, sizeof(*p));
  1552. p->type = type;
  1553. dbgarg(cmd, "type=%s\n", prt_names(p->type, v4l2_type_names));
  1554. ret = ops->vidioc_g_sliced_vbi_cap(file, fh, p);
  1555. if (!ret)
  1556. dbgarg2("service_set=%d\n", p->service_set);
  1557. break;
  1558. }
  1559. case VIDIOC_LOG_STATUS:
  1560. {
  1561. if (!ops->vidioc_log_status)
  1562. break;
  1563. ret = ops->vidioc_log_status(file, fh);
  1564. break;
  1565. }
  1566. #ifdef CONFIG_VIDEO_ADV_DEBUG
  1567. case VIDIOC_DBG_G_REGISTER:
  1568. {
  1569. struct v4l2_register *p = arg;
  1570. if (!capable(CAP_SYS_ADMIN))
  1571. ret = -EPERM;
  1572. else if (ops->vidioc_g_register)
  1573. ret = ops->vidioc_g_register(file, fh, p);
  1574. break;
  1575. }
  1576. case VIDIOC_DBG_S_REGISTER:
  1577. {
  1578. struct v4l2_register *p = arg;
  1579. if (!capable(CAP_SYS_ADMIN))
  1580. ret = -EPERM;
  1581. else if (ops->vidioc_s_register)
  1582. ret = ops->vidioc_s_register(file, fh, p);
  1583. break;
  1584. }
  1585. #endif
  1586. case VIDIOC_G_CHIP_IDENT:
  1587. {
  1588. struct v4l2_chip_ident *p = arg;
  1589. if (!ops->vidioc_g_chip_ident)
  1590. break;
  1591. ret = ops->vidioc_g_chip_ident(file, fh, p);
  1592. if (!ret)
  1593. dbgarg(cmd, "chip_ident=%u, revision=0x%x\n", p->ident, p->revision);
  1594. break;
  1595. }
  1596. case VIDIOC_S_HW_FREQ_SEEK:
  1597. {
  1598. struct v4l2_hw_freq_seek *p = arg;
  1599. if (!ops->vidioc_s_hw_freq_seek)
  1600. break;
  1601. dbgarg(cmd,
  1602. "tuner=%d, type=%d, seek_upward=%d, wrap_around=%d\n",
  1603. p->tuner, p->type, p->seek_upward, p->wrap_around);
  1604. ret = ops->vidioc_s_hw_freq_seek(file, fh, p);
  1605. break;
  1606. }
  1607. default:
  1608. {
  1609. if (!ops->vidioc_default)
  1610. break;
  1611. ret = ops->vidioc_default(file, fh, cmd, arg);
  1612. break;
  1613. }
  1614. } /* switch */
  1615. if (vfd->debug & V4L2_DEBUG_IOCTL_ARG) {
  1616. if (ret < 0) {
  1617. v4l_print_ioctl(vfd->name, cmd);
  1618. printk(KERN_CONT " error %d\n", ret);
  1619. }
  1620. }
  1621. return ret;
  1622. }
  1623. int video_ioctl2(struct inode *inode, struct file *file,
  1624. unsigned int cmd, unsigned long arg)
  1625. {
  1626. char sbuf[128];
  1627. void *mbuf = NULL;
  1628. void *parg = NULL;
  1629. int err = -EINVAL;
  1630. int is_ext_ctrl;
  1631. size_t ctrls_size = 0;
  1632. void __user *user_ptr = NULL;
  1633. #ifdef __OLD_VIDIOC_
  1634. cmd = video_fix_command(cmd);
  1635. #endif
  1636. is_ext_ctrl = (cmd == VIDIOC_S_EXT_CTRLS || cmd == VIDIOC_G_EXT_CTRLS ||
  1637. cmd == VIDIOC_TRY_EXT_CTRLS);
  1638. /* Copy arguments into temp kernel buffer */
  1639. switch (_IOC_DIR(cmd)) {
  1640. case _IOC_NONE:
  1641. parg = NULL;
  1642. break;
  1643. case _IOC_READ:
  1644. case _IOC_WRITE:
  1645. case (_IOC_WRITE | _IOC_READ):
  1646. if (_IOC_SIZE(cmd) <= sizeof(sbuf)) {
  1647. parg = sbuf;
  1648. } else {
  1649. /* too big to allocate from stack */
  1650. mbuf = kmalloc(_IOC_SIZE(cmd), GFP_KERNEL);
  1651. if (NULL == mbuf)
  1652. return -ENOMEM;
  1653. parg = mbuf;
  1654. }
  1655. err = -EFAULT;
  1656. if (_IOC_DIR(cmd) & _IOC_WRITE)
  1657. if (copy_from_user(parg, (void __user *)arg, _IOC_SIZE(cmd)))
  1658. goto out;
  1659. break;
  1660. }
  1661. if (is_ext_ctrl) {
  1662. struct v4l2_ext_controls *p = parg;
  1663. /* In case of an error, tell the caller that it wasn't
  1664. a specific control that caused it. */
  1665. p->error_idx = p->count;
  1666. user_ptr = (void __user *)p->controls;
  1667. if (p->count) {
  1668. ctrls_size = sizeof(struct v4l2_ext_control) * p->count;
  1669. /* Note: v4l2_ext_controls fits in sbuf[] so mbuf is still NULL. */
  1670. mbuf = kmalloc(ctrls_size, GFP_KERNEL);
  1671. err = -ENOMEM;
  1672. if (NULL == mbuf)
  1673. goto out_ext_ctrl;
  1674. err = -EFAULT;
  1675. if (copy_from_user(mbuf, user_ptr, ctrls_size))
  1676. goto out_ext_ctrl;
  1677. p->controls = mbuf;
  1678. }
  1679. }
  1680. /* Handles IOCTL */
  1681. err = __video_do_ioctl(inode, file, cmd, parg);
  1682. if (err == -ENOIOCTLCMD)
  1683. err = -EINVAL;
  1684. if (is_ext_ctrl) {
  1685. struct v4l2_ext_controls *p = parg;
  1686. p->controls = (void *)user_ptr;
  1687. if (p->count && err == 0 && copy_to_user(user_ptr, mbuf, ctrls_size))
  1688. err = -EFAULT;
  1689. goto out_ext_ctrl;
  1690. }
  1691. if (err < 0)
  1692. goto out;
  1693. out_ext_ctrl:
  1694. /* Copy results into user buffer */
  1695. switch (_IOC_DIR(cmd)) {
  1696. case _IOC_READ:
  1697. case (_IOC_WRITE | _IOC_READ):
  1698. if (copy_to_user((void __user *)arg, parg, _IOC_SIZE(cmd)))
  1699. err = -EFAULT;
  1700. break;
  1701. }
  1702. out:
  1703. kfree(mbuf);
  1704. return err;
  1705. }
  1706. EXPORT_SYMBOL(video_ioctl2);