saa7134-video.c 63 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368136913701371137213731374137513761377137813791380138113821383138413851386138713881389139013911392139313941395139613971398139914001401140214031404140514061407140814091410141114121413141414151416141714181419142014211422142314241425142614271428142914301431143214331434143514361437143814391440144114421443144414451446144714481449145014511452145314541455145614571458145914601461146214631464146514661467146814691470147114721473147414751476147714781479148014811482148314841485148614871488148914901491149214931494149514961497149814991500150115021503150415051506150715081509151015111512151315141515151615171518151915201521152215231524152515261527152815291530153115321533153415351536153715381539154015411542154315441545154615471548154915501551155215531554155515561557155815591560156115621563156415651566156715681569157015711572157315741575157615771578157915801581158215831584158515861587158815891590159115921593159415951596159715981599160016011602160316041605160616071608160916101611161216131614161516161617161816191620162116221623162416251626162716281629163016311632163316341635163616371638163916401641164216431644164516461647164816491650165116521653165416551656165716581659166016611662166316641665166616671668166916701671167216731674167516761677167816791680168116821683168416851686168716881689169016911692169316941695169616971698169917001701170217031704170517061707170817091710171117121713171417151716171717181719172017211722172317241725172617271728172917301731173217331734173517361737173817391740174117421743174417451746174717481749175017511752175317541755175617571758175917601761176217631764176517661767176817691770177117721773177417751776177717781779178017811782178317841785178617871788178917901791179217931794179517961797179817991800180118021803180418051806180718081809181018111812181318141815181618171818181918201821182218231824182518261827182818291830183118321833183418351836183718381839184018411842184318441845184618471848184918501851185218531854185518561857185818591860186118621863186418651866186718681869187018711872187318741875187618771878187918801881188218831884188518861887188818891890189118921893189418951896189718981899190019011902190319041905190619071908190919101911191219131914191519161917191819191920192119221923192419251926192719281929193019311932193319341935193619371938193919401941194219431944194519461947194819491950195119521953195419551956195719581959196019611962196319641965196619671968196919701971197219731974197519761977197819791980198119821983198419851986198719881989199019911992199319941995199619971998199920002001200220032004200520062007200820092010201120122013201420152016201720182019202020212022202320242025202620272028202920302031203220332034203520362037203820392040204120422043204420452046204720482049205020512052205320542055205620572058205920602061206220632064206520662067206820692070207120722073207420752076207720782079208020812082208320842085208620872088208920902091209220932094209520962097209820992100210121022103210421052106210721082109211021112112211321142115211621172118211921202121212221232124212521262127212821292130213121322133213421352136213721382139214021412142214321442145214621472148214921502151215221532154215521562157215821592160216121622163216421652166216721682169217021712172217321742175217621772178217921802181218221832184218521862187218821892190219121922193219421952196219721982199220022012202220322042205220622072208220922102211221222132214221522162217221822192220222122222223222422252226222722282229223022312232223322342235223622372238223922402241224222432244224522462247224822492250225122522253225422552256225722582259226022612262226322642265226622672268226922702271227222732274227522762277227822792280228122822283228422852286228722882289229022912292229322942295229622972298229923002301230223032304230523062307230823092310231123122313231423152316231723182319232023212322232323242325232623272328232923302331233223332334233523362337233823392340234123422343234423452346234723482349235023512352235323542355235623572358235923602361236223632364236523662367236823692370237123722373237423752376237723782379238023812382238323842385238623872388238923902391239223932394239523962397239823992400240124022403240424052406240724082409241024112412241324142415241624172418241924202421242224232424242524262427242824292430243124322433243424352436243724382439244024412442244324442445244624472448244924502451245224532454245524562457245824592460246124622463246424652466246724682469247024712472247324742475247624772478247924802481248224832484248524862487248824892490249124922493249424952496249724982499250025012502250325042505250625072508250925102511251225132514251525162517251825192520252125222523
  1. /*
  2. *
  3. * device driver for philips saa7134 based TV cards
  4. * video4linux video interface
  5. *
  6. * (c) 2001-03 Gerd Knorr <kraxel@bytesex.org> [SuSE Labs]
  7. *
  8. * This program is free software; you can redistribute it and/or modify
  9. * it under the terms of the GNU General Public License as published by
  10. * the Free Software Foundation; either version 2 of the License, or
  11. * (at your option) any later version.
  12. *
  13. * This program is distributed in the hope that it will be useful,
  14. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  16. * GNU General Public License for more details.
  17. *
  18. * You should have received a copy of the GNU General Public License
  19. * along with this program; if not, write to the Free Software
  20. * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  21. */
  22. #include <linux/init.h>
  23. #include <linux/list.h>
  24. #include <linux/module.h>
  25. #include <linux/kernel.h>
  26. #include <linux/slab.h>
  27. #include <linux/sort.h>
  28. #include "saa7134-reg.h"
  29. #include "saa7134.h"
  30. #include <media/v4l2-common.h>
  31. #ifdef CONFIG_VIDEO_V4L1_COMPAT
  32. /* Include V4L1 specific functions. Should be removed soon */
  33. #include <linux/videodev.h>
  34. #endif
  35. /* ------------------------------------------------------------------ */
  36. static unsigned int video_debug = 0;
  37. static unsigned int gbuffers = 8;
  38. static unsigned int noninterlaced = 1;
  39. static unsigned int gbufsize = 720*576*4;
  40. static unsigned int gbufsize_max = 720*576*4;
  41. static char secam[] = "--";
  42. module_param(video_debug, int, 0644);
  43. MODULE_PARM_DESC(video_debug,"enable debug messages [video]");
  44. module_param(gbuffers, int, 0444);
  45. MODULE_PARM_DESC(gbuffers,"number of capture buffers, range 2-32");
  46. module_param(noninterlaced, int, 0644);
  47. MODULE_PARM_DESC(noninterlaced,"capture non interlaced video");
  48. module_param_string(secam, secam, sizeof(secam), 0644);
  49. MODULE_PARM_DESC(secam, "force SECAM variant, either DK,L or Lc");
  50. #define dprintk(fmt, arg...) if (video_debug) \
  51. printk(KERN_DEBUG "%s/video: " fmt, dev->name , ## arg)
  52. /* ------------------------------------------------------------------ */
  53. /* Defines for Video Output Port Register at address 0x191 */
  54. /* Bit 0: VIP code T bit polarity */
  55. #define VP_T_CODE_P_NON_INVERTED 0x00
  56. #define VP_T_CODE_P_INVERTED 0x01
  57. /* ------------------------------------------------------------------ */
  58. /* Defines for Video Output Port Register at address 0x195 */
  59. /* Bit 2: Video output clock delay control */
  60. #define VP_CLK_CTRL2_NOT_DELAYED 0x00
  61. #define VP_CLK_CTRL2_DELAYED 0x04
  62. /* Bit 1: Video output clock invert control */
  63. #define VP_CLK_CTRL1_NON_INVERTED 0x00
  64. #define VP_CLK_CTRL1_INVERTED 0x02
  65. /* ------------------------------------------------------------------ */
  66. /* Defines for Video Output Port Register at address 0x196 */
  67. /* Bits 2 to 0: VSYNC pin video vertical sync type */
  68. #define VP_VS_TYPE_MASK 0x07
  69. #define VP_VS_TYPE_OFF 0x00
  70. #define VP_VS_TYPE_V123 0x01
  71. #define VP_VS_TYPE_V_ITU 0x02
  72. #define VP_VS_TYPE_VGATE_L 0x03
  73. #define VP_VS_TYPE_RESERVED1 0x04
  74. #define VP_VS_TYPE_RESERVED2 0x05
  75. #define VP_VS_TYPE_F_ITU 0x06
  76. #define VP_VS_TYPE_SC_FID 0x07
  77. /* ------------------------------------------------------------------ */
  78. /* data structs for video */
  79. static int video_out[][9] = {
  80. [CCIR656] = { 0x00, 0xb1, 0x00, 0xa1, 0x00, 0x04, 0x06, 0x00, 0x00 },
  81. };
  82. static struct saa7134_format formats[] = {
  83. {
  84. .name = "8 bpp gray",
  85. .fourcc = V4L2_PIX_FMT_GREY,
  86. .depth = 8,
  87. .pm = 0x06,
  88. },{
  89. .name = "15 bpp RGB, le",
  90. .fourcc = V4L2_PIX_FMT_RGB555,
  91. .depth = 16,
  92. .pm = 0x13 | 0x80,
  93. },{
  94. .name = "15 bpp RGB, be",
  95. .fourcc = V4L2_PIX_FMT_RGB555X,
  96. .depth = 16,
  97. .pm = 0x13 | 0x80,
  98. .bswap = 1,
  99. },{
  100. .name = "16 bpp RGB, le",
  101. .fourcc = V4L2_PIX_FMT_RGB565,
  102. .depth = 16,
  103. .pm = 0x10 | 0x80,
  104. },{
  105. .name = "16 bpp RGB, be",
  106. .fourcc = V4L2_PIX_FMT_RGB565X,
  107. .depth = 16,
  108. .pm = 0x10 | 0x80,
  109. .bswap = 1,
  110. },{
  111. .name = "24 bpp RGB, le",
  112. .fourcc = V4L2_PIX_FMT_BGR24,
  113. .depth = 24,
  114. .pm = 0x11,
  115. },{
  116. .name = "24 bpp RGB, be",
  117. .fourcc = V4L2_PIX_FMT_RGB24,
  118. .depth = 24,
  119. .pm = 0x11,
  120. .bswap = 1,
  121. },{
  122. .name = "32 bpp RGB, le",
  123. .fourcc = V4L2_PIX_FMT_BGR32,
  124. .depth = 32,
  125. .pm = 0x12,
  126. },{
  127. .name = "32 bpp RGB, be",
  128. .fourcc = V4L2_PIX_FMT_RGB32,
  129. .depth = 32,
  130. .pm = 0x12,
  131. .bswap = 1,
  132. .wswap = 1,
  133. },{
  134. .name = "4:2:2 packed, YUYV",
  135. .fourcc = V4L2_PIX_FMT_YUYV,
  136. .depth = 16,
  137. .pm = 0x00,
  138. .bswap = 1,
  139. .yuv = 1,
  140. },{
  141. .name = "4:2:2 packed, UYVY",
  142. .fourcc = V4L2_PIX_FMT_UYVY,
  143. .depth = 16,
  144. .pm = 0x00,
  145. .yuv = 1,
  146. },{
  147. .name = "4:2:2 planar, Y-Cb-Cr",
  148. .fourcc = V4L2_PIX_FMT_YUV422P,
  149. .depth = 16,
  150. .pm = 0x09,
  151. .yuv = 1,
  152. .planar = 1,
  153. .hshift = 1,
  154. .vshift = 0,
  155. },{
  156. .name = "4:2:0 planar, Y-Cb-Cr",
  157. .fourcc = V4L2_PIX_FMT_YUV420,
  158. .depth = 12,
  159. .pm = 0x0a,
  160. .yuv = 1,
  161. .planar = 1,
  162. .hshift = 1,
  163. .vshift = 1,
  164. },{
  165. .name = "4:2:0 planar, Y-Cb-Cr",
  166. .fourcc = V4L2_PIX_FMT_YVU420,
  167. .depth = 12,
  168. .pm = 0x0a,
  169. .yuv = 1,
  170. .planar = 1,
  171. .uvswap = 1,
  172. .hshift = 1,
  173. .vshift = 1,
  174. }
  175. };
  176. #define FORMATS ARRAY_SIZE(formats)
  177. #define NORM_625_50 \
  178. .h_start = 0, \
  179. .h_stop = 719, \
  180. .video_v_start = 24, \
  181. .video_v_stop = 311, \
  182. .vbi_v_start_0 = 7, \
  183. .vbi_v_stop_0 = 22, \
  184. .vbi_v_start_1 = 319, \
  185. .src_timing = 4
  186. #define NORM_525_60 \
  187. .h_start = 0, \
  188. .h_stop = 703, \
  189. .video_v_start = 23, \
  190. .video_v_stop = 262, \
  191. .vbi_v_start_0 = 10, \
  192. .vbi_v_stop_0 = 21, \
  193. .vbi_v_start_1 = 273, \
  194. .src_timing = 7
  195. static struct saa7134_tvnorm tvnorms[] = {
  196. {
  197. .name = "PAL", /* autodetect */
  198. .id = V4L2_STD_PAL,
  199. NORM_625_50,
  200. .sync_control = 0x18,
  201. .luma_control = 0x40,
  202. .chroma_ctrl1 = 0x81,
  203. .chroma_gain = 0x2a,
  204. .chroma_ctrl2 = 0x06,
  205. .vgate_misc = 0x1c,
  206. },{
  207. .name = "PAL-BG",
  208. .id = V4L2_STD_PAL_BG,
  209. NORM_625_50,
  210. .sync_control = 0x18,
  211. .luma_control = 0x40,
  212. .chroma_ctrl1 = 0x81,
  213. .chroma_gain = 0x2a,
  214. .chroma_ctrl2 = 0x06,
  215. .vgate_misc = 0x1c,
  216. },{
  217. .name = "PAL-I",
  218. .id = V4L2_STD_PAL_I,
  219. NORM_625_50,
  220. .sync_control = 0x18,
  221. .luma_control = 0x40,
  222. .chroma_ctrl1 = 0x81,
  223. .chroma_gain = 0x2a,
  224. .chroma_ctrl2 = 0x06,
  225. .vgate_misc = 0x1c,
  226. },{
  227. .name = "PAL-DK",
  228. .id = V4L2_STD_PAL_DK,
  229. NORM_625_50,
  230. .sync_control = 0x18,
  231. .luma_control = 0x40,
  232. .chroma_ctrl1 = 0x81,
  233. .chroma_gain = 0x2a,
  234. .chroma_ctrl2 = 0x06,
  235. .vgate_misc = 0x1c,
  236. },{
  237. .name = "NTSC",
  238. .id = V4L2_STD_NTSC,
  239. NORM_525_60,
  240. .sync_control = 0x59,
  241. .luma_control = 0x40,
  242. .chroma_ctrl1 = 0x89,
  243. .chroma_gain = 0x2a,
  244. .chroma_ctrl2 = 0x0e,
  245. .vgate_misc = 0x18,
  246. },{
  247. .name = "SECAM",
  248. .id = V4L2_STD_SECAM,
  249. NORM_625_50,
  250. .sync_control = 0x18,
  251. .luma_control = 0x1b,
  252. .chroma_ctrl1 = 0xd1,
  253. .chroma_gain = 0x80,
  254. .chroma_ctrl2 = 0x00,
  255. .vgate_misc = 0x1c,
  256. },{
  257. .name = "SECAM-DK",
  258. .id = V4L2_STD_SECAM_DK,
  259. NORM_625_50,
  260. .sync_control = 0x18,
  261. .luma_control = 0x1b,
  262. .chroma_ctrl1 = 0xd1,
  263. .chroma_gain = 0x80,
  264. .chroma_ctrl2 = 0x00,
  265. .vgate_misc = 0x1c,
  266. },{
  267. .name = "SECAM-L",
  268. .id = V4L2_STD_SECAM_L,
  269. NORM_625_50,
  270. .sync_control = 0x18,
  271. .luma_control = 0x1b,
  272. .chroma_ctrl1 = 0xd1,
  273. .chroma_gain = 0x80,
  274. .chroma_ctrl2 = 0x00,
  275. .vgate_misc = 0x1c,
  276. },{
  277. .name = "SECAM-Lc",
  278. .id = V4L2_STD_SECAM_LC,
  279. NORM_625_50,
  280. .sync_control = 0x18,
  281. .luma_control = 0x1b,
  282. .chroma_ctrl1 = 0xd1,
  283. .chroma_gain = 0x80,
  284. .chroma_ctrl2 = 0x00,
  285. .vgate_misc = 0x1c,
  286. },{
  287. .name = "PAL-M",
  288. .id = V4L2_STD_PAL_M,
  289. NORM_525_60,
  290. .sync_control = 0x59,
  291. .luma_control = 0x40,
  292. .chroma_ctrl1 = 0xb9,
  293. .chroma_gain = 0x2a,
  294. .chroma_ctrl2 = 0x0e,
  295. .vgate_misc = 0x18,
  296. },{
  297. .name = "PAL-Nc",
  298. .id = V4L2_STD_PAL_Nc,
  299. NORM_625_50,
  300. .sync_control = 0x18,
  301. .luma_control = 0x40,
  302. .chroma_ctrl1 = 0xa1,
  303. .chroma_gain = 0x2a,
  304. .chroma_ctrl2 = 0x06,
  305. .vgate_misc = 0x1c,
  306. },{
  307. .name = "PAL-60",
  308. .id = V4L2_STD_PAL_60,
  309. .h_start = 0,
  310. .h_stop = 719,
  311. .video_v_start = 23,
  312. .video_v_stop = 262,
  313. .vbi_v_start_0 = 10,
  314. .vbi_v_stop_0 = 21,
  315. .vbi_v_start_1 = 273,
  316. .src_timing = 7,
  317. .sync_control = 0x18,
  318. .luma_control = 0x40,
  319. .chroma_ctrl1 = 0x81,
  320. .chroma_gain = 0x2a,
  321. .chroma_ctrl2 = 0x06,
  322. .vgate_misc = 0x1c,
  323. }
  324. };
  325. #define TVNORMS ARRAY_SIZE(tvnorms)
  326. #define V4L2_CID_PRIVATE_INVERT (V4L2_CID_PRIVATE_BASE + 0)
  327. #define V4L2_CID_PRIVATE_Y_ODD (V4L2_CID_PRIVATE_BASE + 1)
  328. #define V4L2_CID_PRIVATE_Y_EVEN (V4L2_CID_PRIVATE_BASE + 2)
  329. #define V4L2_CID_PRIVATE_AUTOMUTE (V4L2_CID_PRIVATE_BASE + 3)
  330. #define V4L2_CID_PRIVATE_LASTP1 (V4L2_CID_PRIVATE_BASE + 4)
  331. static const struct v4l2_queryctrl no_ctrl = {
  332. .name = "42",
  333. .flags = V4L2_CTRL_FLAG_DISABLED,
  334. };
  335. static const struct v4l2_queryctrl video_ctrls[] = {
  336. /* --- video --- */
  337. {
  338. .id = V4L2_CID_BRIGHTNESS,
  339. .name = "Brightness",
  340. .minimum = 0,
  341. .maximum = 255,
  342. .step = 1,
  343. .default_value = 128,
  344. .type = V4L2_CTRL_TYPE_INTEGER,
  345. },{
  346. .id = V4L2_CID_CONTRAST,
  347. .name = "Contrast",
  348. .minimum = 0,
  349. .maximum = 127,
  350. .step = 1,
  351. .default_value = 68,
  352. .type = V4L2_CTRL_TYPE_INTEGER,
  353. },{
  354. .id = V4L2_CID_SATURATION,
  355. .name = "Saturation",
  356. .minimum = 0,
  357. .maximum = 127,
  358. .step = 1,
  359. .default_value = 64,
  360. .type = V4L2_CTRL_TYPE_INTEGER,
  361. },{
  362. .id = V4L2_CID_HUE,
  363. .name = "Hue",
  364. .minimum = -128,
  365. .maximum = 127,
  366. .step = 1,
  367. .default_value = 0,
  368. .type = V4L2_CTRL_TYPE_INTEGER,
  369. },{
  370. .id = V4L2_CID_HFLIP,
  371. .name = "Mirror",
  372. .minimum = 0,
  373. .maximum = 1,
  374. .type = V4L2_CTRL_TYPE_BOOLEAN,
  375. },
  376. /* --- audio --- */
  377. {
  378. .id = V4L2_CID_AUDIO_MUTE,
  379. .name = "Mute",
  380. .minimum = 0,
  381. .maximum = 1,
  382. .type = V4L2_CTRL_TYPE_BOOLEAN,
  383. },{
  384. .id = V4L2_CID_AUDIO_VOLUME,
  385. .name = "Volume",
  386. .minimum = -15,
  387. .maximum = 15,
  388. .step = 1,
  389. .default_value = 0,
  390. .type = V4L2_CTRL_TYPE_INTEGER,
  391. },
  392. /* --- private --- */
  393. {
  394. .id = V4L2_CID_PRIVATE_INVERT,
  395. .name = "Invert",
  396. .minimum = 0,
  397. .maximum = 1,
  398. .type = V4L2_CTRL_TYPE_BOOLEAN,
  399. },{
  400. .id = V4L2_CID_PRIVATE_Y_ODD,
  401. .name = "y offset odd field",
  402. .minimum = 0,
  403. .maximum = 128,
  404. .default_value = 0,
  405. .type = V4L2_CTRL_TYPE_INTEGER,
  406. },{
  407. .id = V4L2_CID_PRIVATE_Y_EVEN,
  408. .name = "y offset even field",
  409. .minimum = 0,
  410. .maximum = 128,
  411. .default_value = 0,
  412. .type = V4L2_CTRL_TYPE_INTEGER,
  413. },{
  414. .id = V4L2_CID_PRIVATE_AUTOMUTE,
  415. .name = "automute",
  416. .minimum = 0,
  417. .maximum = 1,
  418. .default_value = 1,
  419. .type = V4L2_CTRL_TYPE_BOOLEAN,
  420. }
  421. };
  422. static const unsigned int CTRLS = ARRAY_SIZE(video_ctrls);
  423. static const struct v4l2_queryctrl* ctrl_by_id(unsigned int id)
  424. {
  425. unsigned int i;
  426. for (i = 0; i < CTRLS; i++)
  427. if (video_ctrls[i].id == id)
  428. return video_ctrls+i;
  429. return NULL;
  430. }
  431. static struct saa7134_format* format_by_fourcc(unsigned int fourcc)
  432. {
  433. unsigned int i;
  434. for (i = 0; i < FORMATS; i++)
  435. if (formats[i].fourcc == fourcc)
  436. return formats+i;
  437. return NULL;
  438. }
  439. /* ----------------------------------------------------------------------- */
  440. /* resource management */
  441. static int res_get(struct saa7134_dev *dev, struct saa7134_fh *fh, unsigned int bit)
  442. {
  443. if (fh->resources & bit)
  444. /* have it already allocated */
  445. return 1;
  446. /* is it free? */
  447. mutex_lock(&dev->lock);
  448. if (dev->resources & bit) {
  449. /* no, someone else uses it */
  450. mutex_unlock(&dev->lock);
  451. return 0;
  452. }
  453. /* it's free, grab it */
  454. fh->resources |= bit;
  455. dev->resources |= bit;
  456. dprintk("res: get %d\n",bit);
  457. mutex_unlock(&dev->lock);
  458. return 1;
  459. }
  460. static int res_check(struct saa7134_fh *fh, unsigned int bit)
  461. {
  462. return (fh->resources & bit);
  463. }
  464. static int res_locked(struct saa7134_dev *dev, unsigned int bit)
  465. {
  466. return (dev->resources & bit);
  467. }
  468. static
  469. void res_free(struct saa7134_dev *dev, struct saa7134_fh *fh, unsigned int bits)
  470. {
  471. BUG_ON((fh->resources & bits) != bits);
  472. mutex_lock(&dev->lock);
  473. fh->resources &= ~bits;
  474. dev->resources &= ~bits;
  475. dprintk("res: put %d\n",bits);
  476. mutex_unlock(&dev->lock);
  477. }
  478. /* ------------------------------------------------------------------ */
  479. static void set_tvnorm(struct saa7134_dev *dev, struct saa7134_tvnorm *norm)
  480. {
  481. int luma_control,sync_control,mux;
  482. dprintk("set tv norm = %s\n",norm->name);
  483. dev->tvnorm = norm;
  484. mux = card_in(dev,dev->ctl_input).vmux;
  485. luma_control = norm->luma_control;
  486. sync_control = norm->sync_control;
  487. if (mux > 5)
  488. luma_control |= 0x80; /* svideo */
  489. if (noninterlaced || dev->nosignal)
  490. sync_control |= 0x20;
  491. /* setup cropping */
  492. dev->crop_bounds.left = norm->h_start;
  493. dev->crop_defrect.left = norm->h_start;
  494. dev->crop_bounds.width = norm->h_stop - norm->h_start +1;
  495. dev->crop_defrect.width = norm->h_stop - norm->h_start +1;
  496. dev->crop_bounds.top = (norm->vbi_v_stop_0+1)*2;
  497. dev->crop_defrect.top = norm->video_v_start*2;
  498. dev->crop_bounds.height = ((norm->id & V4L2_STD_525_60) ? 524 : 624)
  499. - dev->crop_bounds.top;
  500. dev->crop_defrect.height = (norm->video_v_stop - norm->video_v_start +1)*2;
  501. dev->crop_current = dev->crop_defrect;
  502. /* setup video decoder */
  503. saa_writeb(SAA7134_INCR_DELAY, 0x08);
  504. saa_writeb(SAA7134_ANALOG_IN_CTRL1, 0xc0 | mux);
  505. saa_writeb(SAA7134_ANALOG_IN_CTRL2, 0x00);
  506. saa_writeb(SAA7134_ANALOG_IN_CTRL3, 0x90);
  507. saa_writeb(SAA7134_ANALOG_IN_CTRL4, 0x90);
  508. saa_writeb(SAA7134_HSYNC_START, 0xeb);
  509. saa_writeb(SAA7134_HSYNC_STOP, 0xe0);
  510. saa_writeb(SAA7134_SOURCE_TIMING1, norm->src_timing);
  511. saa_writeb(SAA7134_SYNC_CTRL, sync_control);
  512. saa_writeb(SAA7134_LUMA_CTRL, luma_control);
  513. saa_writeb(SAA7134_DEC_LUMA_BRIGHT, dev->ctl_bright);
  514. saa_writeb(SAA7134_DEC_LUMA_CONTRAST, dev->ctl_contrast);
  515. saa_writeb(SAA7134_DEC_CHROMA_SATURATION, dev->ctl_saturation);
  516. saa_writeb(SAA7134_DEC_CHROMA_HUE, dev->ctl_hue);
  517. saa_writeb(SAA7134_CHROMA_CTRL1, norm->chroma_ctrl1);
  518. saa_writeb(SAA7134_CHROMA_GAIN, norm->chroma_gain);
  519. saa_writeb(SAA7134_CHROMA_CTRL2, norm->chroma_ctrl2);
  520. saa_writeb(SAA7134_MODE_DELAY_CTRL, 0x00);
  521. saa_writeb(SAA7134_ANALOG_ADC, 0x01);
  522. saa_writeb(SAA7134_VGATE_START, 0x11);
  523. saa_writeb(SAA7134_VGATE_STOP, 0xfe);
  524. saa_writeb(SAA7134_MISC_VGATE_MSB, norm->vgate_misc);
  525. saa_writeb(SAA7134_RAW_DATA_GAIN, 0x40);
  526. saa_writeb(SAA7134_RAW_DATA_OFFSET, 0x80);
  527. /* only tell the tuner if this is a tv input */
  528. if (card_in(dev,dev->ctl_input).tv) {
  529. if ((card(dev).tuner_type == TUNER_PHILIPS_TDA8290)
  530. && ((card(dev).tuner_config == 1)
  531. || (card(dev).tuner_config == 2)))
  532. saa7134_set_gpio(dev, 22, 5);
  533. saa7134_i2c_call_clients(dev,VIDIOC_S_STD,&norm->id);
  534. }
  535. }
  536. static void video_mux(struct saa7134_dev *dev, int input)
  537. {
  538. dprintk("video input = %d [%s]\n",input,card_in(dev,input).name);
  539. dev->ctl_input = input;
  540. set_tvnorm(dev,dev->tvnorm);
  541. saa7134_tvaudio_setinput(dev,&card_in(dev,input));
  542. }
  543. static void set_h_prescale(struct saa7134_dev *dev, int task, int prescale)
  544. {
  545. static const struct {
  546. int xpsc;
  547. int xacl;
  548. int xc2_1;
  549. int xdcg;
  550. int vpfy;
  551. } vals[] = {
  552. /* XPSC XACL XC2_1 XDCG VPFY */
  553. { 1, 0, 0, 0, 0 },
  554. { 2, 2, 1, 2, 2 },
  555. { 3, 4, 1, 3, 2 },
  556. { 4, 8, 1, 4, 2 },
  557. { 5, 8, 1, 4, 2 },
  558. { 6, 8, 1, 4, 3 },
  559. { 7, 8, 1, 4, 3 },
  560. { 8, 15, 0, 4, 3 },
  561. { 9, 15, 0, 4, 3 },
  562. { 10, 16, 1, 5, 3 },
  563. };
  564. static const int count = ARRAY_SIZE(vals);
  565. int i;
  566. for (i = 0; i < count; i++)
  567. if (vals[i].xpsc == prescale)
  568. break;
  569. if (i == count)
  570. return;
  571. saa_writeb(SAA7134_H_PRESCALE(task), vals[i].xpsc);
  572. saa_writeb(SAA7134_ACC_LENGTH(task), vals[i].xacl);
  573. saa_writeb(SAA7134_LEVEL_CTRL(task),
  574. (vals[i].xc2_1 << 3) | (vals[i].xdcg));
  575. saa_andorb(SAA7134_FIR_PREFILTER_CTRL(task), 0x0f,
  576. (vals[i].vpfy << 2) | vals[i].vpfy);
  577. }
  578. static void set_v_scale(struct saa7134_dev *dev, int task, int yscale)
  579. {
  580. int val,mirror;
  581. saa_writeb(SAA7134_V_SCALE_RATIO1(task), yscale & 0xff);
  582. saa_writeb(SAA7134_V_SCALE_RATIO2(task), yscale >> 8);
  583. mirror = (dev->ctl_mirror) ? 0x02 : 0x00;
  584. if (yscale < 2048) {
  585. /* LPI */
  586. dprintk("yscale LPI yscale=%d\n",yscale);
  587. saa_writeb(SAA7134_V_FILTER(task), 0x00 | mirror);
  588. saa_writeb(SAA7134_LUMA_CONTRAST(task), 0x40);
  589. saa_writeb(SAA7134_CHROMA_SATURATION(task), 0x40);
  590. } else {
  591. /* ACM */
  592. val = 0x40 * 1024 / yscale;
  593. dprintk("yscale ACM yscale=%d val=0x%x\n",yscale,val);
  594. saa_writeb(SAA7134_V_FILTER(task), 0x01 | mirror);
  595. saa_writeb(SAA7134_LUMA_CONTRAST(task), val);
  596. saa_writeb(SAA7134_CHROMA_SATURATION(task), val);
  597. }
  598. saa_writeb(SAA7134_LUMA_BRIGHT(task), 0x80);
  599. }
  600. static void set_size(struct saa7134_dev *dev, int task,
  601. int width, int height, int interlace)
  602. {
  603. int prescale,xscale,yscale,y_even,y_odd;
  604. int h_start, h_stop, v_start, v_stop;
  605. int div = interlace ? 2 : 1;
  606. /* setup video scaler */
  607. h_start = dev->crop_current.left;
  608. v_start = dev->crop_current.top/2;
  609. h_stop = (dev->crop_current.left + dev->crop_current.width -1);
  610. v_stop = (dev->crop_current.top + dev->crop_current.height -1)/2;
  611. saa_writeb(SAA7134_VIDEO_H_START1(task), h_start & 0xff);
  612. saa_writeb(SAA7134_VIDEO_H_START2(task), h_start >> 8);
  613. saa_writeb(SAA7134_VIDEO_H_STOP1(task), h_stop & 0xff);
  614. saa_writeb(SAA7134_VIDEO_H_STOP2(task), h_stop >> 8);
  615. saa_writeb(SAA7134_VIDEO_V_START1(task), v_start & 0xff);
  616. saa_writeb(SAA7134_VIDEO_V_START2(task), v_start >> 8);
  617. saa_writeb(SAA7134_VIDEO_V_STOP1(task), v_stop & 0xff);
  618. saa_writeb(SAA7134_VIDEO_V_STOP2(task), v_stop >> 8);
  619. prescale = dev->crop_current.width / width;
  620. if (0 == prescale)
  621. prescale = 1;
  622. xscale = 1024 * dev->crop_current.width / prescale / width;
  623. yscale = 512 * div * dev->crop_current.height / height;
  624. dprintk("prescale=%d xscale=%d yscale=%d\n",prescale,xscale,yscale);
  625. set_h_prescale(dev,task,prescale);
  626. saa_writeb(SAA7134_H_SCALE_INC1(task), xscale & 0xff);
  627. saa_writeb(SAA7134_H_SCALE_INC2(task), xscale >> 8);
  628. set_v_scale(dev,task,yscale);
  629. saa_writeb(SAA7134_VIDEO_PIXELS1(task), width & 0xff);
  630. saa_writeb(SAA7134_VIDEO_PIXELS2(task), width >> 8);
  631. saa_writeb(SAA7134_VIDEO_LINES1(task), height/div & 0xff);
  632. saa_writeb(SAA7134_VIDEO_LINES2(task), height/div >> 8);
  633. /* deinterlace y offsets */
  634. y_odd = dev->ctl_y_odd;
  635. y_even = dev->ctl_y_even;
  636. saa_writeb(SAA7134_V_PHASE_OFFSET0(task), y_odd);
  637. saa_writeb(SAA7134_V_PHASE_OFFSET1(task), y_even);
  638. saa_writeb(SAA7134_V_PHASE_OFFSET2(task), y_odd);
  639. saa_writeb(SAA7134_V_PHASE_OFFSET3(task), y_even);
  640. }
  641. /* ------------------------------------------------------------------ */
  642. struct cliplist {
  643. __u16 position;
  644. __u8 enable;
  645. __u8 disable;
  646. };
  647. static void set_cliplist(struct saa7134_dev *dev, int reg,
  648. struct cliplist *cl, int entries, char *name)
  649. {
  650. __u8 winbits = 0;
  651. int i;
  652. for (i = 0; i < entries; i++) {
  653. winbits |= cl[i].enable;
  654. winbits &= ~cl[i].disable;
  655. if (i < 15 && cl[i].position == cl[i+1].position)
  656. continue;
  657. saa_writeb(reg + 0, winbits);
  658. saa_writeb(reg + 2, cl[i].position & 0xff);
  659. saa_writeb(reg + 3, cl[i].position >> 8);
  660. dprintk("clip: %s winbits=%02x pos=%d\n",
  661. name,winbits,cl[i].position);
  662. reg += 8;
  663. }
  664. for (; reg < 0x400; reg += 8) {
  665. saa_writeb(reg+ 0, 0);
  666. saa_writeb(reg + 1, 0);
  667. saa_writeb(reg + 2, 0);
  668. saa_writeb(reg + 3, 0);
  669. }
  670. }
  671. static int clip_range(int val)
  672. {
  673. if (val < 0)
  674. val = 0;
  675. return val;
  676. }
  677. /* Sort into smallest position first order */
  678. static int cliplist_cmp(const void *a, const void *b)
  679. {
  680. const struct cliplist *cla = a;
  681. const struct cliplist *clb = b;
  682. if (cla->position < clb->position)
  683. return -1;
  684. if (cla->position > clb->position)
  685. return 1;
  686. return 0;
  687. }
  688. static int setup_clipping(struct saa7134_dev *dev, struct v4l2_clip *clips,
  689. int nclips, int interlace)
  690. {
  691. struct cliplist col[16], row[16];
  692. int cols = 0, rows = 0, i;
  693. int div = interlace ? 2 : 1;
  694. memset(col, 0, sizeof(col));
  695. memset(row, 0, sizeof(row));
  696. for (i = 0; i < nclips && i < 8; i++) {
  697. col[cols].position = clip_range(clips[i].c.left);
  698. col[cols].enable = (1 << i);
  699. cols++;
  700. col[cols].position = clip_range(clips[i].c.left+clips[i].c.width);
  701. col[cols].disable = (1 << i);
  702. cols++;
  703. row[rows].position = clip_range(clips[i].c.top / div);
  704. row[rows].enable = (1 << i);
  705. rows++;
  706. row[rows].position = clip_range((clips[i].c.top + clips[i].c.height)
  707. / div);
  708. row[rows].disable = (1 << i);
  709. rows++;
  710. }
  711. sort(col, cols, sizeof col[0], cliplist_cmp, NULL);
  712. sort(row, rows, sizeof row[0], cliplist_cmp, NULL);
  713. set_cliplist(dev,0x380,col,cols,"cols");
  714. set_cliplist(dev,0x384,row,rows,"rows");
  715. return 0;
  716. }
  717. static int verify_preview(struct saa7134_dev *dev, struct v4l2_window *win)
  718. {
  719. enum v4l2_field field;
  720. int maxw, maxh;
  721. if (NULL == dev->ovbuf.base)
  722. return -EINVAL;
  723. if (NULL == dev->ovfmt)
  724. return -EINVAL;
  725. if (win->w.width < 48 || win->w.height < 32)
  726. return -EINVAL;
  727. if (win->clipcount > 2048)
  728. return -EINVAL;
  729. field = win->field;
  730. maxw = dev->crop_current.width;
  731. maxh = dev->crop_current.height;
  732. if (V4L2_FIELD_ANY == field) {
  733. field = (win->w.height > maxh/2)
  734. ? V4L2_FIELD_INTERLACED
  735. : V4L2_FIELD_TOP;
  736. }
  737. switch (field) {
  738. case V4L2_FIELD_TOP:
  739. case V4L2_FIELD_BOTTOM:
  740. maxh = maxh / 2;
  741. break;
  742. case V4L2_FIELD_INTERLACED:
  743. break;
  744. default:
  745. return -EINVAL;
  746. }
  747. win->field = field;
  748. if (win->w.width > maxw)
  749. win->w.width = maxw;
  750. if (win->w.height > maxh)
  751. win->w.height = maxh;
  752. return 0;
  753. }
  754. static int start_preview(struct saa7134_dev *dev, struct saa7134_fh *fh)
  755. {
  756. unsigned long base,control,bpl;
  757. int err;
  758. err = verify_preview(dev,&fh->win);
  759. if (0 != err)
  760. return err;
  761. dev->ovfield = fh->win.field;
  762. dprintk("start_preview %dx%d+%d+%d %s field=%s\n",
  763. fh->win.w.width,fh->win.w.height,
  764. fh->win.w.left,fh->win.w.top,
  765. dev->ovfmt->name,v4l2_field_names[dev->ovfield]);
  766. /* setup window + clipping */
  767. set_size(dev,TASK_B,fh->win.w.width,fh->win.w.height,
  768. V4L2_FIELD_HAS_BOTH(dev->ovfield));
  769. setup_clipping(dev,fh->clips,fh->nclips,
  770. V4L2_FIELD_HAS_BOTH(dev->ovfield));
  771. if (dev->ovfmt->yuv)
  772. saa_andorb(SAA7134_DATA_PATH(TASK_B), 0x3f, 0x03);
  773. else
  774. saa_andorb(SAA7134_DATA_PATH(TASK_B), 0x3f, 0x01);
  775. saa_writeb(SAA7134_OFMT_VIDEO_B, dev->ovfmt->pm | 0x20);
  776. /* dma: setup channel 1 (= Video Task B) */
  777. base = (unsigned long)dev->ovbuf.base;
  778. base += dev->ovbuf.fmt.bytesperline * fh->win.w.top;
  779. base += dev->ovfmt->depth/8 * fh->win.w.left;
  780. bpl = dev->ovbuf.fmt.bytesperline;
  781. control = SAA7134_RS_CONTROL_BURST_16;
  782. if (dev->ovfmt->bswap)
  783. control |= SAA7134_RS_CONTROL_BSWAP;
  784. if (dev->ovfmt->wswap)
  785. control |= SAA7134_RS_CONTROL_WSWAP;
  786. if (V4L2_FIELD_HAS_BOTH(dev->ovfield)) {
  787. saa_writel(SAA7134_RS_BA1(1),base);
  788. saa_writel(SAA7134_RS_BA2(1),base+bpl);
  789. saa_writel(SAA7134_RS_PITCH(1),bpl*2);
  790. saa_writel(SAA7134_RS_CONTROL(1),control);
  791. } else {
  792. saa_writel(SAA7134_RS_BA1(1),base);
  793. saa_writel(SAA7134_RS_BA2(1),base);
  794. saa_writel(SAA7134_RS_PITCH(1),bpl);
  795. saa_writel(SAA7134_RS_CONTROL(1),control);
  796. }
  797. /* start dma */
  798. dev->ovenable = 1;
  799. saa7134_set_dmabits(dev);
  800. return 0;
  801. }
  802. static int stop_preview(struct saa7134_dev *dev, struct saa7134_fh *fh)
  803. {
  804. dev->ovenable = 0;
  805. saa7134_set_dmabits(dev);
  806. return 0;
  807. }
  808. /* ------------------------------------------------------------------ */
  809. static int buffer_activate(struct saa7134_dev *dev,
  810. struct saa7134_buf *buf,
  811. struct saa7134_buf *next)
  812. {
  813. unsigned long base,control,bpl;
  814. unsigned long bpl_uv,lines_uv,base2,base3,tmp; /* planar */
  815. dprintk("buffer_activate buf=%p\n",buf);
  816. buf->vb.state = STATE_ACTIVE;
  817. buf->top_seen = 0;
  818. set_size(dev,TASK_A,buf->vb.width,buf->vb.height,
  819. V4L2_FIELD_HAS_BOTH(buf->vb.field));
  820. if (buf->fmt->yuv)
  821. saa_andorb(SAA7134_DATA_PATH(TASK_A), 0x3f, 0x03);
  822. else
  823. saa_andorb(SAA7134_DATA_PATH(TASK_A), 0x3f, 0x01);
  824. saa_writeb(SAA7134_OFMT_VIDEO_A, buf->fmt->pm);
  825. /* DMA: setup channel 0 (= Video Task A0) */
  826. base = saa7134_buffer_base(buf);
  827. if (buf->fmt->planar)
  828. bpl = buf->vb.width;
  829. else
  830. bpl = (buf->vb.width * buf->fmt->depth) / 8;
  831. control = SAA7134_RS_CONTROL_BURST_16 |
  832. SAA7134_RS_CONTROL_ME |
  833. (buf->pt->dma >> 12);
  834. if (buf->fmt->bswap)
  835. control |= SAA7134_RS_CONTROL_BSWAP;
  836. if (buf->fmt->wswap)
  837. control |= SAA7134_RS_CONTROL_WSWAP;
  838. if (V4L2_FIELD_HAS_BOTH(buf->vb.field)) {
  839. /* interlaced */
  840. saa_writel(SAA7134_RS_BA1(0),base);
  841. saa_writel(SAA7134_RS_BA2(0),base+bpl);
  842. saa_writel(SAA7134_RS_PITCH(0),bpl*2);
  843. } else {
  844. /* non-interlaced */
  845. saa_writel(SAA7134_RS_BA1(0),base);
  846. saa_writel(SAA7134_RS_BA2(0),base);
  847. saa_writel(SAA7134_RS_PITCH(0),bpl);
  848. }
  849. saa_writel(SAA7134_RS_CONTROL(0),control);
  850. if (buf->fmt->planar) {
  851. /* DMA: setup channel 4+5 (= planar task A) */
  852. bpl_uv = bpl >> buf->fmt->hshift;
  853. lines_uv = buf->vb.height >> buf->fmt->vshift;
  854. base2 = base + bpl * buf->vb.height;
  855. base3 = base2 + bpl_uv * lines_uv;
  856. if (buf->fmt->uvswap)
  857. tmp = base2, base2 = base3, base3 = tmp;
  858. dprintk("uv: bpl=%ld lines=%ld base2/3=%ld/%ld\n",
  859. bpl_uv,lines_uv,base2,base3);
  860. if (V4L2_FIELD_HAS_BOTH(buf->vb.field)) {
  861. /* interlaced */
  862. saa_writel(SAA7134_RS_BA1(4),base2);
  863. saa_writel(SAA7134_RS_BA2(4),base2+bpl_uv);
  864. saa_writel(SAA7134_RS_PITCH(4),bpl_uv*2);
  865. saa_writel(SAA7134_RS_BA1(5),base3);
  866. saa_writel(SAA7134_RS_BA2(5),base3+bpl_uv);
  867. saa_writel(SAA7134_RS_PITCH(5),bpl_uv*2);
  868. } else {
  869. /* non-interlaced */
  870. saa_writel(SAA7134_RS_BA1(4),base2);
  871. saa_writel(SAA7134_RS_BA2(4),base2);
  872. saa_writel(SAA7134_RS_PITCH(4),bpl_uv);
  873. saa_writel(SAA7134_RS_BA1(5),base3);
  874. saa_writel(SAA7134_RS_BA2(5),base3);
  875. saa_writel(SAA7134_RS_PITCH(5),bpl_uv);
  876. }
  877. saa_writel(SAA7134_RS_CONTROL(4),control);
  878. saa_writel(SAA7134_RS_CONTROL(5),control);
  879. }
  880. /* start DMA */
  881. saa7134_set_dmabits(dev);
  882. mod_timer(&dev->video_q.timeout, jiffies+BUFFER_TIMEOUT);
  883. return 0;
  884. }
  885. static int buffer_prepare(struct videobuf_queue *q,
  886. struct videobuf_buffer *vb,
  887. enum v4l2_field field)
  888. {
  889. struct saa7134_fh *fh = q->priv_data;
  890. struct saa7134_dev *dev = fh->dev;
  891. struct saa7134_buf *buf = container_of(vb,struct saa7134_buf,vb);
  892. unsigned int size;
  893. int err;
  894. /* sanity checks */
  895. if (NULL == fh->fmt)
  896. return -EINVAL;
  897. if (fh->width < 48 ||
  898. fh->height < 32 ||
  899. fh->width/4 > dev->crop_current.width ||
  900. fh->height/4 > dev->crop_current.height ||
  901. fh->width > dev->crop_bounds.width ||
  902. fh->height > dev->crop_bounds.height)
  903. return -EINVAL;
  904. size = (fh->width * fh->height * fh->fmt->depth) >> 3;
  905. if (0 != buf->vb.baddr && buf->vb.bsize < size)
  906. return -EINVAL;
  907. dprintk("buffer_prepare [%d,size=%dx%d,bytes=%d,fields=%s,%s]\n",
  908. vb->i,fh->width,fh->height,size,v4l2_field_names[field],
  909. fh->fmt->name);
  910. if (buf->vb.width != fh->width ||
  911. buf->vb.height != fh->height ||
  912. buf->vb.size != size ||
  913. buf->vb.field != field ||
  914. buf->fmt != fh->fmt) {
  915. saa7134_dma_free(q,buf);
  916. }
  917. if (STATE_NEEDS_INIT == buf->vb.state) {
  918. buf->vb.width = fh->width;
  919. buf->vb.height = fh->height;
  920. buf->vb.size = size;
  921. buf->vb.field = field;
  922. buf->fmt = fh->fmt;
  923. buf->pt = &fh->pt_cap;
  924. err = videobuf_iolock(q,&buf->vb,&dev->ovbuf);
  925. if (err)
  926. goto oops;
  927. err = saa7134_pgtable_build(dev->pci,buf->pt,
  928. buf->vb.dma.sglist,
  929. buf->vb.dma.sglen,
  930. saa7134_buffer_startpage(buf));
  931. if (err)
  932. goto oops;
  933. }
  934. buf->vb.state = STATE_PREPARED;
  935. buf->activate = buffer_activate;
  936. return 0;
  937. oops:
  938. saa7134_dma_free(q,buf);
  939. return err;
  940. }
  941. static int
  942. buffer_setup(struct videobuf_queue *q, unsigned int *count, unsigned int *size)
  943. {
  944. struct saa7134_fh *fh = q->priv_data;
  945. *size = fh->fmt->depth * fh->width * fh->height >> 3;
  946. if (0 == *count)
  947. *count = gbuffers;
  948. *count = saa7134_buffer_count(*size,*count);
  949. return 0;
  950. }
  951. static void buffer_queue(struct videobuf_queue *q, struct videobuf_buffer *vb)
  952. {
  953. struct saa7134_fh *fh = q->priv_data;
  954. struct saa7134_buf *buf = container_of(vb,struct saa7134_buf,vb);
  955. saa7134_buffer_queue(fh->dev,&fh->dev->video_q,buf);
  956. }
  957. static void buffer_release(struct videobuf_queue *q, struct videobuf_buffer *vb)
  958. {
  959. struct saa7134_buf *buf = container_of(vb,struct saa7134_buf,vb);
  960. saa7134_dma_free(q,buf);
  961. }
  962. static struct videobuf_queue_ops video_qops = {
  963. .buf_setup = buffer_setup,
  964. .buf_prepare = buffer_prepare,
  965. .buf_queue = buffer_queue,
  966. .buf_release = buffer_release,
  967. };
  968. /* ------------------------------------------------------------------ */
  969. static int get_control(struct saa7134_dev *dev, struct v4l2_control *c)
  970. {
  971. const struct v4l2_queryctrl* ctrl;
  972. ctrl = ctrl_by_id(c->id);
  973. if (NULL == ctrl)
  974. return -EINVAL;
  975. switch (c->id) {
  976. case V4L2_CID_BRIGHTNESS:
  977. c->value = dev->ctl_bright;
  978. break;
  979. case V4L2_CID_HUE:
  980. c->value = dev->ctl_hue;
  981. break;
  982. case V4L2_CID_CONTRAST:
  983. c->value = dev->ctl_contrast;
  984. break;
  985. case V4L2_CID_SATURATION:
  986. c->value = dev->ctl_saturation;
  987. break;
  988. case V4L2_CID_AUDIO_MUTE:
  989. c->value = dev->ctl_mute;
  990. break;
  991. case V4L2_CID_AUDIO_VOLUME:
  992. c->value = dev->ctl_volume;
  993. break;
  994. case V4L2_CID_PRIVATE_INVERT:
  995. c->value = dev->ctl_invert;
  996. break;
  997. case V4L2_CID_HFLIP:
  998. c->value = dev->ctl_mirror;
  999. break;
  1000. case V4L2_CID_PRIVATE_Y_EVEN:
  1001. c->value = dev->ctl_y_even;
  1002. break;
  1003. case V4L2_CID_PRIVATE_Y_ODD:
  1004. c->value = dev->ctl_y_odd;
  1005. break;
  1006. case V4L2_CID_PRIVATE_AUTOMUTE:
  1007. c->value = dev->ctl_automute;
  1008. break;
  1009. default:
  1010. return -EINVAL;
  1011. }
  1012. return 0;
  1013. }
  1014. static int set_control(struct saa7134_dev *dev, struct saa7134_fh *fh,
  1015. struct v4l2_control *c)
  1016. {
  1017. const struct v4l2_queryctrl* ctrl;
  1018. unsigned long flags;
  1019. int restart_overlay = 0;
  1020. ctrl = ctrl_by_id(c->id);
  1021. if (NULL == ctrl)
  1022. return -EINVAL;
  1023. dprintk("set_control name=%s val=%d\n",ctrl->name,c->value);
  1024. switch (ctrl->type) {
  1025. case V4L2_CTRL_TYPE_BOOLEAN:
  1026. case V4L2_CTRL_TYPE_MENU:
  1027. case V4L2_CTRL_TYPE_INTEGER:
  1028. if (c->value < ctrl->minimum)
  1029. c->value = ctrl->minimum;
  1030. if (c->value > ctrl->maximum)
  1031. c->value = ctrl->maximum;
  1032. break;
  1033. default:
  1034. /* nothing */;
  1035. };
  1036. switch (c->id) {
  1037. case V4L2_CID_BRIGHTNESS:
  1038. dev->ctl_bright = c->value;
  1039. saa_writeb(SAA7134_DEC_LUMA_BRIGHT, dev->ctl_bright);
  1040. break;
  1041. case V4L2_CID_HUE:
  1042. dev->ctl_hue = c->value;
  1043. saa_writeb(SAA7134_DEC_CHROMA_HUE, dev->ctl_hue);
  1044. break;
  1045. case V4L2_CID_CONTRAST:
  1046. dev->ctl_contrast = c->value;
  1047. saa_writeb(SAA7134_DEC_LUMA_CONTRAST,
  1048. dev->ctl_invert ? -dev->ctl_contrast : dev->ctl_contrast);
  1049. break;
  1050. case V4L2_CID_SATURATION:
  1051. dev->ctl_saturation = c->value;
  1052. saa_writeb(SAA7134_DEC_CHROMA_SATURATION,
  1053. dev->ctl_invert ? -dev->ctl_saturation : dev->ctl_saturation);
  1054. break;
  1055. case V4L2_CID_AUDIO_MUTE:
  1056. dev->ctl_mute = c->value;
  1057. saa7134_tvaudio_setmute(dev);
  1058. break;
  1059. case V4L2_CID_AUDIO_VOLUME:
  1060. dev->ctl_volume = c->value;
  1061. saa7134_tvaudio_setvolume(dev,dev->ctl_volume);
  1062. break;
  1063. case V4L2_CID_PRIVATE_INVERT:
  1064. dev->ctl_invert = c->value;
  1065. saa_writeb(SAA7134_DEC_LUMA_CONTRAST,
  1066. dev->ctl_invert ? -dev->ctl_contrast : dev->ctl_contrast);
  1067. saa_writeb(SAA7134_DEC_CHROMA_SATURATION,
  1068. dev->ctl_invert ? -dev->ctl_saturation : dev->ctl_saturation);
  1069. break;
  1070. case V4L2_CID_HFLIP:
  1071. dev->ctl_mirror = c->value;
  1072. restart_overlay = 1;
  1073. break;
  1074. case V4L2_CID_PRIVATE_Y_EVEN:
  1075. dev->ctl_y_even = c->value;
  1076. restart_overlay = 1;
  1077. break;
  1078. case V4L2_CID_PRIVATE_Y_ODD:
  1079. dev->ctl_y_odd = c->value;
  1080. restart_overlay = 1;
  1081. break;
  1082. case V4L2_CID_PRIVATE_AUTOMUTE:
  1083. dev->ctl_automute = c->value;
  1084. if (dev->tda9887_conf) {
  1085. if (dev->ctl_automute)
  1086. dev->tda9887_conf |= TDA9887_AUTOMUTE;
  1087. else
  1088. dev->tda9887_conf &= ~TDA9887_AUTOMUTE;
  1089. saa7134_i2c_call_clients(dev, TDA9887_SET_CONFIG,
  1090. &dev->tda9887_conf);
  1091. }
  1092. break;
  1093. default:
  1094. return -EINVAL;
  1095. }
  1096. if (restart_overlay && fh && res_check(fh, RESOURCE_OVERLAY)) {
  1097. spin_lock_irqsave(&dev->slock,flags);
  1098. stop_preview(dev,fh);
  1099. start_preview(dev,fh);
  1100. spin_unlock_irqrestore(&dev->slock,flags);
  1101. }
  1102. return 0;
  1103. }
  1104. /* ------------------------------------------------------------------ */
  1105. static struct videobuf_queue* saa7134_queue(struct saa7134_fh *fh)
  1106. {
  1107. struct videobuf_queue* q = NULL;
  1108. switch (fh->type) {
  1109. case V4L2_BUF_TYPE_VIDEO_CAPTURE:
  1110. q = &fh->cap;
  1111. break;
  1112. case V4L2_BUF_TYPE_VBI_CAPTURE:
  1113. q = &fh->vbi;
  1114. break;
  1115. default:
  1116. BUG();
  1117. }
  1118. return q;
  1119. }
  1120. static int saa7134_resource(struct saa7134_fh *fh)
  1121. {
  1122. if (fh->type == V4L2_BUF_TYPE_VIDEO_CAPTURE)
  1123. return RESOURCE_VIDEO;
  1124. if (fh->type == V4L2_BUF_TYPE_VBI_CAPTURE)
  1125. return RESOURCE_VBI;
  1126. BUG();
  1127. return 0;
  1128. }
  1129. static int video_open(struct inode *inode, struct file *file)
  1130. {
  1131. int minor = iminor(inode);
  1132. struct saa7134_dev *h,*dev = NULL;
  1133. struct saa7134_fh *fh;
  1134. struct list_head *list;
  1135. enum v4l2_buf_type type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
  1136. int radio = 0;
  1137. list_for_each(list,&saa7134_devlist) {
  1138. h = list_entry(list, struct saa7134_dev, devlist);
  1139. if (h->video_dev && (h->video_dev->minor == minor))
  1140. dev = h;
  1141. if (h->radio_dev && (h->radio_dev->minor == minor)) {
  1142. radio = 1;
  1143. dev = h;
  1144. }
  1145. if (h->vbi_dev && (h->vbi_dev->minor == minor)) {
  1146. type = V4L2_BUF_TYPE_VBI_CAPTURE;
  1147. dev = h;
  1148. }
  1149. }
  1150. if (NULL == dev)
  1151. return -ENODEV;
  1152. dprintk("open minor=%d radio=%d type=%s\n",minor,radio,
  1153. v4l2_type_names[type]);
  1154. /* allocate + initialize per filehandle data */
  1155. fh = kzalloc(sizeof(*fh),GFP_KERNEL);
  1156. if (NULL == fh)
  1157. return -ENOMEM;
  1158. file->private_data = fh;
  1159. fh->dev = dev;
  1160. fh->radio = radio;
  1161. fh->type = type;
  1162. fh->fmt = format_by_fourcc(V4L2_PIX_FMT_BGR24);
  1163. fh->width = 720;
  1164. fh->height = 576;
  1165. v4l2_prio_open(&dev->prio,&fh->prio);
  1166. videobuf_queue_init(&fh->cap, &video_qops,
  1167. dev->pci, &dev->slock,
  1168. V4L2_BUF_TYPE_VIDEO_CAPTURE,
  1169. V4L2_FIELD_INTERLACED,
  1170. sizeof(struct saa7134_buf),
  1171. fh);
  1172. videobuf_queue_init(&fh->vbi, &saa7134_vbi_qops,
  1173. dev->pci, &dev->slock,
  1174. V4L2_BUF_TYPE_VBI_CAPTURE,
  1175. V4L2_FIELD_SEQ_TB,
  1176. sizeof(struct saa7134_buf),
  1177. fh);
  1178. saa7134_pgtable_alloc(dev->pci,&fh->pt_cap);
  1179. saa7134_pgtable_alloc(dev->pci,&fh->pt_vbi);
  1180. if (fh->radio) {
  1181. /* switch to radio mode */
  1182. saa7134_tvaudio_setinput(dev,&card(dev).radio);
  1183. saa7134_i2c_call_clients(dev,AUDC_SET_RADIO, NULL);
  1184. } else {
  1185. /* switch to video/vbi mode */
  1186. video_mux(dev,dev->ctl_input);
  1187. }
  1188. return 0;
  1189. }
  1190. static ssize_t
  1191. video_read(struct file *file, char __user *data, size_t count, loff_t *ppos)
  1192. {
  1193. struct saa7134_fh *fh = file->private_data;
  1194. switch (fh->type) {
  1195. case V4L2_BUF_TYPE_VIDEO_CAPTURE:
  1196. if (res_locked(fh->dev,RESOURCE_VIDEO))
  1197. return -EBUSY;
  1198. return videobuf_read_one(saa7134_queue(fh),
  1199. data, count, ppos,
  1200. file->f_flags & O_NONBLOCK);
  1201. case V4L2_BUF_TYPE_VBI_CAPTURE:
  1202. if (!res_get(fh->dev,fh,RESOURCE_VBI))
  1203. return -EBUSY;
  1204. return videobuf_read_stream(saa7134_queue(fh),
  1205. data, count, ppos, 1,
  1206. file->f_flags & O_NONBLOCK);
  1207. break;
  1208. default:
  1209. BUG();
  1210. return 0;
  1211. }
  1212. }
  1213. static unsigned int
  1214. video_poll(struct file *file, struct poll_table_struct *wait)
  1215. {
  1216. struct saa7134_fh *fh = file->private_data;
  1217. struct videobuf_buffer *buf = NULL;
  1218. if (V4L2_BUF_TYPE_VBI_CAPTURE == fh->type)
  1219. return videobuf_poll_stream(file, &fh->vbi, wait);
  1220. if (res_check(fh,RESOURCE_VIDEO)) {
  1221. if (!list_empty(&fh->cap.stream))
  1222. buf = list_entry(fh->cap.stream.next, struct videobuf_buffer, stream);
  1223. } else {
  1224. mutex_lock(&fh->cap.lock);
  1225. if (UNSET == fh->cap.read_off) {
  1226. /* need to capture a new frame */
  1227. if (res_locked(fh->dev,RESOURCE_VIDEO)) {
  1228. mutex_unlock(&fh->cap.lock);
  1229. return POLLERR;
  1230. }
  1231. if (0 != fh->cap.ops->buf_prepare(&fh->cap,fh->cap.read_buf,fh->cap.field)) {
  1232. mutex_unlock(&fh->cap.lock);
  1233. return POLLERR;
  1234. }
  1235. fh->cap.ops->buf_queue(&fh->cap,fh->cap.read_buf);
  1236. fh->cap.read_off = 0;
  1237. }
  1238. mutex_unlock(&fh->cap.lock);
  1239. buf = fh->cap.read_buf;
  1240. }
  1241. if (!buf)
  1242. return POLLERR;
  1243. poll_wait(file, &buf->done, wait);
  1244. if (buf->state == STATE_DONE ||
  1245. buf->state == STATE_ERROR)
  1246. return POLLIN|POLLRDNORM;
  1247. return 0;
  1248. }
  1249. static int video_release(struct inode *inode, struct file *file)
  1250. {
  1251. struct saa7134_fh *fh = file->private_data;
  1252. struct saa7134_dev *dev = fh->dev;
  1253. unsigned long flags;
  1254. /* turn off overlay */
  1255. if (res_check(fh, RESOURCE_OVERLAY)) {
  1256. spin_lock_irqsave(&dev->slock,flags);
  1257. stop_preview(dev,fh);
  1258. spin_unlock_irqrestore(&dev->slock,flags);
  1259. res_free(dev,fh,RESOURCE_OVERLAY);
  1260. }
  1261. /* stop video capture */
  1262. if (res_check(fh, RESOURCE_VIDEO)) {
  1263. videobuf_streamoff(&fh->cap);
  1264. res_free(dev,fh,RESOURCE_VIDEO);
  1265. }
  1266. if (fh->cap.read_buf) {
  1267. buffer_release(&fh->cap,fh->cap.read_buf);
  1268. kfree(fh->cap.read_buf);
  1269. }
  1270. /* stop vbi capture */
  1271. if (res_check(fh, RESOURCE_VBI)) {
  1272. if (fh->vbi.streaming)
  1273. videobuf_streamoff(&fh->vbi);
  1274. if (fh->vbi.reading)
  1275. videobuf_read_stop(&fh->vbi);
  1276. res_free(dev,fh,RESOURCE_VBI);
  1277. }
  1278. /* ts-capture will not work in planar mode, so turn it off Hac: 04.05*/
  1279. saa_andorb(SAA7134_OFMT_VIDEO_A, 0x1f, 0);
  1280. saa_andorb(SAA7134_OFMT_VIDEO_B, 0x1f, 0);
  1281. saa_andorb(SAA7134_OFMT_DATA_A, 0x1f, 0);
  1282. saa_andorb(SAA7134_OFMT_DATA_B, 0x1f, 0);
  1283. saa7134_i2c_call_clients(dev, TUNER_SET_STANDBY, NULL);
  1284. /* free stuff */
  1285. videobuf_mmap_free(&fh->cap);
  1286. videobuf_mmap_free(&fh->vbi);
  1287. saa7134_pgtable_free(dev->pci,&fh->pt_cap);
  1288. saa7134_pgtable_free(dev->pci,&fh->pt_vbi);
  1289. v4l2_prio_close(&dev->prio,&fh->prio);
  1290. file->private_data = NULL;
  1291. kfree(fh);
  1292. return 0;
  1293. }
  1294. static int video_mmap(struct file *file, struct vm_area_struct * vma)
  1295. {
  1296. struct saa7134_fh *fh = file->private_data;
  1297. return videobuf_mmap_mapper(saa7134_queue(fh), vma);
  1298. }
  1299. /* ------------------------------------------------------------------ */
  1300. static void saa7134_vbi_fmt(struct saa7134_dev *dev, struct v4l2_format *f)
  1301. {
  1302. struct saa7134_tvnorm *norm = dev->tvnorm;
  1303. f->fmt.vbi.sampling_rate = 6750000 * 4;
  1304. f->fmt.vbi.samples_per_line = 2048 /* VBI_LINE_LENGTH */;
  1305. f->fmt.vbi.sample_format = V4L2_PIX_FMT_GREY;
  1306. f->fmt.vbi.offset = 64 * 4;
  1307. f->fmt.vbi.start[0] = norm->vbi_v_start_0;
  1308. f->fmt.vbi.count[0] = norm->vbi_v_stop_0 - norm->vbi_v_start_0 +1;
  1309. f->fmt.vbi.start[1] = norm->vbi_v_start_1;
  1310. f->fmt.vbi.count[1] = f->fmt.vbi.count[0];
  1311. f->fmt.vbi.flags = 0; /* VBI_UNSYNC VBI_INTERLACED */
  1312. }
  1313. static int saa7134_g_fmt(struct saa7134_dev *dev, struct saa7134_fh *fh,
  1314. struct v4l2_format *f)
  1315. {
  1316. switch (f->type) {
  1317. case V4L2_BUF_TYPE_VIDEO_CAPTURE:
  1318. memset(&f->fmt.pix,0,sizeof(f->fmt.pix));
  1319. f->fmt.pix.width = fh->width;
  1320. f->fmt.pix.height = fh->height;
  1321. f->fmt.pix.field = fh->cap.field;
  1322. f->fmt.pix.pixelformat = fh->fmt->fourcc;
  1323. f->fmt.pix.bytesperline =
  1324. (f->fmt.pix.width * fh->fmt->depth) >> 3;
  1325. f->fmt.pix.sizeimage =
  1326. f->fmt.pix.height * f->fmt.pix.bytesperline;
  1327. return 0;
  1328. case V4L2_BUF_TYPE_VIDEO_OVERLAY:
  1329. if (saa7134_no_overlay > 0) {
  1330. printk ("V4L2_BUF_TYPE_VIDEO_OVERLAY: no_overlay\n");
  1331. return -EINVAL;
  1332. }
  1333. f->fmt.win = fh->win;
  1334. return 0;
  1335. case V4L2_BUF_TYPE_VBI_CAPTURE:
  1336. saa7134_vbi_fmt(dev,f);
  1337. return 0;
  1338. default:
  1339. return -EINVAL;
  1340. }
  1341. }
  1342. static int saa7134_try_fmt(struct saa7134_dev *dev, struct saa7134_fh *fh,
  1343. struct v4l2_format *f)
  1344. {
  1345. int err;
  1346. switch (f->type) {
  1347. case V4L2_BUF_TYPE_VIDEO_CAPTURE:
  1348. {
  1349. struct saa7134_format *fmt;
  1350. enum v4l2_field field;
  1351. unsigned int maxw, maxh;
  1352. fmt = format_by_fourcc(f->fmt.pix.pixelformat);
  1353. if (NULL == fmt)
  1354. return -EINVAL;
  1355. field = f->fmt.pix.field;
  1356. maxw = min(dev->crop_current.width*4, dev->crop_bounds.width);
  1357. maxh = min(dev->crop_current.height*4, dev->crop_bounds.height);
  1358. if (V4L2_FIELD_ANY == field) {
  1359. field = (f->fmt.pix.height > maxh/2)
  1360. ? V4L2_FIELD_INTERLACED
  1361. : V4L2_FIELD_BOTTOM;
  1362. }
  1363. switch (field) {
  1364. case V4L2_FIELD_TOP:
  1365. case V4L2_FIELD_BOTTOM:
  1366. maxh = maxh / 2;
  1367. break;
  1368. case V4L2_FIELD_INTERLACED:
  1369. break;
  1370. default:
  1371. return -EINVAL;
  1372. }
  1373. f->fmt.pix.field = field;
  1374. if (f->fmt.pix.width < 48)
  1375. f->fmt.pix.width = 48;
  1376. if (f->fmt.pix.height < 32)
  1377. f->fmt.pix.height = 32;
  1378. if (f->fmt.pix.width > maxw)
  1379. f->fmt.pix.width = maxw;
  1380. if (f->fmt.pix.height > maxh)
  1381. f->fmt.pix.height = maxh;
  1382. f->fmt.pix.width &= ~0x03;
  1383. f->fmt.pix.bytesperline =
  1384. (f->fmt.pix.width * fmt->depth) >> 3;
  1385. f->fmt.pix.sizeimage =
  1386. f->fmt.pix.height * f->fmt.pix.bytesperline;
  1387. return 0;
  1388. }
  1389. case V4L2_BUF_TYPE_VIDEO_OVERLAY:
  1390. if (saa7134_no_overlay > 0) {
  1391. printk ("V4L2_BUF_TYPE_VIDEO_OVERLAY: no_overlay\n");
  1392. return -EINVAL;
  1393. }
  1394. err = verify_preview(dev,&f->fmt.win);
  1395. if (0 != err)
  1396. return err;
  1397. return 0;
  1398. case V4L2_BUF_TYPE_VBI_CAPTURE:
  1399. saa7134_vbi_fmt(dev,f);
  1400. return 0;
  1401. default:
  1402. return -EINVAL;
  1403. }
  1404. }
  1405. static int saa7134_s_fmt(struct saa7134_dev *dev, struct saa7134_fh *fh,
  1406. struct v4l2_format *f)
  1407. {
  1408. unsigned long flags;
  1409. int err;
  1410. switch (f->type) {
  1411. case V4L2_BUF_TYPE_VIDEO_CAPTURE:
  1412. err = saa7134_try_fmt(dev,fh,f);
  1413. if (0 != err)
  1414. return err;
  1415. fh->fmt = format_by_fourcc(f->fmt.pix.pixelformat);
  1416. fh->width = f->fmt.pix.width;
  1417. fh->height = f->fmt.pix.height;
  1418. fh->cap.field = f->fmt.pix.field;
  1419. return 0;
  1420. case V4L2_BUF_TYPE_VIDEO_OVERLAY:
  1421. if (saa7134_no_overlay > 0) {
  1422. printk ("V4L2_BUF_TYPE_VIDEO_OVERLAY: no_overlay\n");
  1423. return -EINVAL;
  1424. }
  1425. err = verify_preview(dev,&f->fmt.win);
  1426. if (0 != err)
  1427. return err;
  1428. mutex_lock(&dev->lock);
  1429. fh->win = f->fmt.win;
  1430. fh->nclips = f->fmt.win.clipcount;
  1431. if (fh->nclips > 8)
  1432. fh->nclips = 8;
  1433. if (copy_from_user(fh->clips,f->fmt.win.clips,
  1434. sizeof(struct v4l2_clip)*fh->nclips)) {
  1435. mutex_unlock(&dev->lock);
  1436. return -EFAULT;
  1437. }
  1438. if (res_check(fh, RESOURCE_OVERLAY)) {
  1439. spin_lock_irqsave(&dev->slock,flags);
  1440. stop_preview(dev,fh);
  1441. start_preview(dev,fh);
  1442. spin_unlock_irqrestore(&dev->slock,flags);
  1443. }
  1444. mutex_unlock(&dev->lock);
  1445. return 0;
  1446. case V4L2_BUF_TYPE_VBI_CAPTURE:
  1447. saa7134_vbi_fmt(dev,f);
  1448. return 0;
  1449. default:
  1450. return -EINVAL;
  1451. }
  1452. }
  1453. int saa7134_common_ioctl(struct saa7134_dev *dev,
  1454. unsigned int cmd, void *arg)
  1455. {
  1456. int err;
  1457. switch (cmd) {
  1458. case VIDIOC_QUERYCTRL:
  1459. {
  1460. const struct v4l2_queryctrl *ctrl;
  1461. struct v4l2_queryctrl *c = arg;
  1462. if ((c->id < V4L2_CID_BASE ||
  1463. c->id >= V4L2_CID_LASTP1) &&
  1464. (c->id < V4L2_CID_PRIVATE_BASE ||
  1465. c->id >= V4L2_CID_PRIVATE_LASTP1))
  1466. return -EINVAL;
  1467. ctrl = ctrl_by_id(c->id);
  1468. *c = (NULL != ctrl) ? *ctrl : no_ctrl;
  1469. return 0;
  1470. }
  1471. case VIDIOC_G_CTRL:
  1472. return get_control(dev,arg);
  1473. case VIDIOC_S_CTRL:
  1474. {
  1475. mutex_lock(&dev->lock);
  1476. err = set_control(dev,NULL,arg);
  1477. mutex_unlock(&dev->lock);
  1478. return err;
  1479. }
  1480. /* --- input switching --------------------------------------- */
  1481. case VIDIOC_ENUMINPUT:
  1482. {
  1483. struct v4l2_input *i = arg;
  1484. unsigned int n;
  1485. n = i->index;
  1486. if (n >= SAA7134_INPUT_MAX)
  1487. return -EINVAL;
  1488. if (NULL == card_in(dev,i->index).name)
  1489. return -EINVAL;
  1490. memset(i,0,sizeof(*i));
  1491. i->index = n;
  1492. i->type = V4L2_INPUT_TYPE_CAMERA;
  1493. strcpy(i->name,card_in(dev,n).name);
  1494. if (card_in(dev,n).tv)
  1495. i->type = V4L2_INPUT_TYPE_TUNER;
  1496. i->audioset = 1;
  1497. if (n == dev->ctl_input) {
  1498. int v1 = saa_readb(SAA7134_STATUS_VIDEO1);
  1499. int v2 = saa_readb(SAA7134_STATUS_VIDEO2);
  1500. if (0 != (v1 & 0x40))
  1501. i->status |= V4L2_IN_ST_NO_H_LOCK;
  1502. if (0 != (v2 & 0x40))
  1503. i->status |= V4L2_IN_ST_NO_SYNC;
  1504. if (0 != (v2 & 0x0e))
  1505. i->status |= V4L2_IN_ST_MACROVISION;
  1506. }
  1507. for (n = 0; n < TVNORMS; n++)
  1508. i->std |= tvnorms[n].id;
  1509. return 0;
  1510. }
  1511. case VIDIOC_G_INPUT:
  1512. {
  1513. int *i = arg;
  1514. *i = dev->ctl_input;
  1515. return 0;
  1516. }
  1517. case VIDIOC_S_INPUT:
  1518. {
  1519. int *i = arg;
  1520. if (*i < 0 || *i >= SAA7134_INPUT_MAX)
  1521. return -EINVAL;
  1522. if (NULL == card_in(dev,*i).name)
  1523. return -EINVAL;
  1524. mutex_lock(&dev->lock);
  1525. video_mux(dev,*i);
  1526. mutex_unlock(&dev->lock);
  1527. return 0;
  1528. }
  1529. }
  1530. return 0;
  1531. }
  1532. EXPORT_SYMBOL(saa7134_common_ioctl);
  1533. /*
  1534. * This function is _not_ called directly, but from
  1535. * video_generic_ioctl (and maybe others). userspace
  1536. * copying is done already, arg is a kernel pointer.
  1537. */
  1538. static int video_do_ioctl(struct inode *inode, struct file *file,
  1539. unsigned int cmd, void *arg)
  1540. {
  1541. struct saa7134_fh *fh = file->private_data;
  1542. struct saa7134_dev *dev = fh->dev;
  1543. unsigned long flags;
  1544. int err;
  1545. if (video_debug > 1)
  1546. v4l_print_ioctl(dev->name,cmd);
  1547. switch (cmd) {
  1548. case VIDIOC_S_CTRL:
  1549. case VIDIOC_S_STD:
  1550. case VIDIOC_S_INPUT:
  1551. case VIDIOC_S_TUNER:
  1552. case VIDIOC_S_FREQUENCY:
  1553. err = v4l2_prio_check(&dev->prio,&fh->prio);
  1554. if (0 != err)
  1555. return err;
  1556. }
  1557. switch (cmd) {
  1558. case VIDIOC_QUERYCAP:
  1559. {
  1560. struct v4l2_capability *cap = arg;
  1561. unsigned int tuner_type = dev->tuner_type;
  1562. memset(cap,0,sizeof(*cap));
  1563. strcpy(cap->driver, "saa7134");
  1564. strlcpy(cap->card, saa7134_boards[dev->board].name,
  1565. sizeof(cap->card));
  1566. sprintf(cap->bus_info,"PCI:%s",pci_name(dev->pci));
  1567. cap->version = SAA7134_VERSION_CODE;
  1568. cap->capabilities =
  1569. V4L2_CAP_VIDEO_CAPTURE |
  1570. V4L2_CAP_VBI_CAPTURE |
  1571. V4L2_CAP_READWRITE |
  1572. V4L2_CAP_STREAMING |
  1573. V4L2_CAP_TUNER;
  1574. if (saa7134_no_overlay <= 0) {
  1575. cap->capabilities |= V4L2_CAP_VIDEO_OVERLAY;
  1576. }
  1577. if ((tuner_type == TUNER_ABSENT) || (tuner_type == UNSET))
  1578. cap->capabilities &= ~V4L2_CAP_TUNER;
  1579. return 0;
  1580. }
  1581. /* --- tv standards ------------------------------------------ */
  1582. case VIDIOC_ENUMSTD:
  1583. {
  1584. struct v4l2_standard *e = arg;
  1585. unsigned int i;
  1586. i = e->index;
  1587. if (i >= TVNORMS)
  1588. return -EINVAL;
  1589. err = v4l2_video_std_construct(e, tvnorms[e->index].id,
  1590. tvnorms[e->index].name);
  1591. e->index = i;
  1592. if (err < 0)
  1593. return err;
  1594. return 0;
  1595. }
  1596. case VIDIOC_G_STD:
  1597. {
  1598. v4l2_std_id *id = arg;
  1599. *id = dev->tvnorm->id;
  1600. return 0;
  1601. }
  1602. case VIDIOC_S_STD:
  1603. {
  1604. v4l2_std_id *id = arg;
  1605. unsigned int i;
  1606. v4l2_std_id fixup;
  1607. for (i = 0; i < TVNORMS; i++)
  1608. if (*id == tvnorms[i].id)
  1609. break;
  1610. if (i == TVNORMS)
  1611. for (i = 0; i < TVNORMS; i++)
  1612. if (*id & tvnorms[i].id)
  1613. break;
  1614. if (i == TVNORMS)
  1615. return -EINVAL;
  1616. if ((*id & V4L2_STD_SECAM) && (secam[0] != '-')) {
  1617. if (secam[0] == 'L' || secam[0] == 'l') {
  1618. if (secam[1] == 'C' || secam[1] == 'c')
  1619. fixup = V4L2_STD_SECAM_LC;
  1620. else
  1621. fixup = V4L2_STD_SECAM_L;
  1622. } else {
  1623. if (secam[0] == 'D' || secam[0] == 'd')
  1624. fixup = V4L2_STD_SECAM_DK;
  1625. else
  1626. fixup = V4L2_STD_SECAM;
  1627. }
  1628. for (i = 0; i < TVNORMS; i++)
  1629. if (fixup == tvnorms[i].id)
  1630. break;
  1631. }
  1632. mutex_lock(&dev->lock);
  1633. if (res_check(fh, RESOURCE_OVERLAY)) {
  1634. spin_lock_irqsave(&dev->slock,flags);
  1635. stop_preview(dev,fh);
  1636. set_tvnorm(dev,&tvnorms[i]);
  1637. start_preview(dev,fh);
  1638. spin_unlock_irqrestore(&dev->slock,flags);
  1639. } else
  1640. set_tvnorm(dev,&tvnorms[i]);
  1641. saa7134_tvaudio_do_scan(dev);
  1642. mutex_unlock(&dev->lock);
  1643. return 0;
  1644. }
  1645. case VIDIOC_CROPCAP:
  1646. {
  1647. struct v4l2_cropcap *cap = arg;
  1648. if (cap->type != V4L2_BUF_TYPE_VIDEO_CAPTURE &&
  1649. cap->type != V4L2_BUF_TYPE_VIDEO_OVERLAY)
  1650. return -EINVAL;
  1651. cap->bounds = dev->crop_bounds;
  1652. cap->defrect = dev->crop_defrect;
  1653. cap->pixelaspect.numerator = 1;
  1654. cap->pixelaspect.denominator = 1;
  1655. if (dev->tvnorm->id & V4L2_STD_525_60) {
  1656. cap->pixelaspect.numerator = 11;
  1657. cap->pixelaspect.denominator = 10;
  1658. }
  1659. if (dev->tvnorm->id & V4L2_STD_625_50) {
  1660. cap->pixelaspect.numerator = 54;
  1661. cap->pixelaspect.denominator = 59;
  1662. }
  1663. return 0;
  1664. }
  1665. case VIDIOC_G_CROP:
  1666. {
  1667. struct v4l2_crop * crop = arg;
  1668. if (crop->type != V4L2_BUF_TYPE_VIDEO_CAPTURE &&
  1669. crop->type != V4L2_BUF_TYPE_VIDEO_OVERLAY)
  1670. return -EINVAL;
  1671. crop->c = dev->crop_current;
  1672. return 0;
  1673. }
  1674. case VIDIOC_S_CROP:
  1675. {
  1676. struct v4l2_crop *crop = arg;
  1677. struct v4l2_rect *b = &dev->crop_bounds;
  1678. if (crop->type != V4L2_BUF_TYPE_VIDEO_CAPTURE &&
  1679. crop->type != V4L2_BUF_TYPE_VIDEO_OVERLAY)
  1680. return -EINVAL;
  1681. if (crop->c.height < 0)
  1682. return -EINVAL;
  1683. if (crop->c.width < 0)
  1684. return -EINVAL;
  1685. if (res_locked(fh->dev,RESOURCE_OVERLAY))
  1686. return -EBUSY;
  1687. if (res_locked(fh->dev,RESOURCE_VIDEO))
  1688. return -EBUSY;
  1689. if (crop->c.top < b->top)
  1690. crop->c.top = b->top;
  1691. if (crop->c.top > b->top + b->height)
  1692. crop->c.top = b->top + b->height;
  1693. if (crop->c.height > b->top - crop->c.top + b->height)
  1694. crop->c.height = b->top - crop->c.top + b->height;
  1695. if (crop->c.left < b->left)
  1696. crop->c.left = b->left;
  1697. if (crop->c.left > b->left + b->width)
  1698. crop->c.left = b->left + b->width;
  1699. if (crop->c.width > b->left - crop->c.left + b->width)
  1700. crop->c.width = b->left - crop->c.left + b->width;
  1701. dev->crop_current = crop->c;
  1702. return 0;
  1703. }
  1704. /* --- tuner ioctls ------------------------------------------ */
  1705. case VIDIOC_G_TUNER:
  1706. {
  1707. struct v4l2_tuner *t = arg;
  1708. int n;
  1709. if (0 != t->index)
  1710. return -EINVAL;
  1711. memset(t,0,sizeof(*t));
  1712. for (n = 0; n < SAA7134_INPUT_MAX; n++)
  1713. if (card_in(dev,n).tv)
  1714. break;
  1715. if (NULL != card_in(dev,n).name) {
  1716. strcpy(t->name, "Television");
  1717. t->type = V4L2_TUNER_ANALOG_TV;
  1718. t->capability = V4L2_TUNER_CAP_NORM |
  1719. V4L2_TUNER_CAP_STEREO |
  1720. V4L2_TUNER_CAP_LANG1 |
  1721. V4L2_TUNER_CAP_LANG2;
  1722. t->rangehigh = 0xffffffffUL;
  1723. t->rxsubchans = saa7134_tvaudio_getstereo(dev);
  1724. t->audmode = saa7134_tvaudio_rx2mode(t->rxsubchans);
  1725. }
  1726. if (0 != (saa_readb(SAA7134_STATUS_VIDEO1) & 0x03))
  1727. t->signal = 0xffff;
  1728. return 0;
  1729. }
  1730. case VIDIOC_S_TUNER:
  1731. {
  1732. struct v4l2_tuner *t = arg;
  1733. int rx,mode;
  1734. mode = dev->thread.mode;
  1735. if (UNSET == mode) {
  1736. rx = saa7134_tvaudio_getstereo(dev);
  1737. mode = saa7134_tvaudio_rx2mode(t->rxsubchans);
  1738. }
  1739. if (mode != t->audmode) {
  1740. dev->thread.mode = t->audmode;
  1741. }
  1742. return 0;
  1743. }
  1744. case VIDIOC_G_FREQUENCY:
  1745. {
  1746. struct v4l2_frequency *f = arg;
  1747. memset(f,0,sizeof(*f));
  1748. f->type = fh->radio ? V4L2_TUNER_RADIO : V4L2_TUNER_ANALOG_TV;
  1749. f->frequency = dev->ctl_freq;
  1750. return 0;
  1751. }
  1752. case VIDIOC_S_FREQUENCY:
  1753. {
  1754. struct v4l2_frequency *f = arg;
  1755. if (0 != f->tuner)
  1756. return -EINVAL;
  1757. if (0 == fh->radio && V4L2_TUNER_ANALOG_TV != f->type)
  1758. return -EINVAL;
  1759. if (1 == fh->radio && V4L2_TUNER_RADIO != f->type)
  1760. return -EINVAL;
  1761. mutex_lock(&dev->lock);
  1762. dev->ctl_freq = f->frequency;
  1763. saa7134_i2c_call_clients(dev,VIDIOC_S_FREQUENCY,f);
  1764. saa7134_tvaudio_do_scan(dev);
  1765. mutex_unlock(&dev->lock);
  1766. return 0;
  1767. }
  1768. /* --- control ioctls ---------------------------------------- */
  1769. case VIDIOC_ENUMINPUT:
  1770. case VIDIOC_G_INPUT:
  1771. case VIDIOC_S_INPUT:
  1772. case VIDIOC_QUERYCTRL:
  1773. case VIDIOC_G_CTRL:
  1774. case VIDIOC_S_CTRL:
  1775. return saa7134_common_ioctl(dev, cmd, arg);
  1776. case VIDIOC_G_AUDIO:
  1777. {
  1778. struct v4l2_audio *a = arg;
  1779. memset(a,0,sizeof(*a));
  1780. strcpy(a->name,"audio");
  1781. return 0;
  1782. }
  1783. case VIDIOC_S_AUDIO:
  1784. return 0;
  1785. case VIDIOC_G_PARM:
  1786. {
  1787. struct v4l2_captureparm *parm = arg;
  1788. memset(parm,0,sizeof(*parm));
  1789. return 0;
  1790. }
  1791. case VIDIOC_G_PRIORITY:
  1792. {
  1793. enum v4l2_priority *p = arg;
  1794. *p = v4l2_prio_max(&dev->prio);
  1795. return 0;
  1796. }
  1797. case VIDIOC_S_PRIORITY:
  1798. {
  1799. enum v4l2_priority *prio = arg;
  1800. return v4l2_prio_change(&dev->prio, &fh->prio, *prio);
  1801. }
  1802. /* --- preview ioctls ---------------------------------------- */
  1803. case VIDIOC_ENUM_FMT:
  1804. {
  1805. struct v4l2_fmtdesc *f = arg;
  1806. enum v4l2_buf_type type;
  1807. unsigned int index;
  1808. index = f->index;
  1809. type = f->type;
  1810. switch (type) {
  1811. case V4L2_BUF_TYPE_VIDEO_CAPTURE:
  1812. case V4L2_BUF_TYPE_VIDEO_OVERLAY:
  1813. if (saa7134_no_overlay > 0) {
  1814. printk ("V4L2_BUF_TYPE_VIDEO_OVERLAY: no_overlay\n");
  1815. return -EINVAL;
  1816. }
  1817. if (index >= FORMATS)
  1818. return -EINVAL;
  1819. if (f->type == V4L2_BUF_TYPE_VIDEO_OVERLAY &&
  1820. formats[index].planar)
  1821. return -EINVAL;
  1822. memset(f,0,sizeof(*f));
  1823. f->index = index;
  1824. f->type = type;
  1825. strlcpy(f->description,formats[index].name,sizeof(f->description));
  1826. f->pixelformat = formats[index].fourcc;
  1827. break;
  1828. case V4L2_BUF_TYPE_VBI_CAPTURE:
  1829. if (0 != index)
  1830. return -EINVAL;
  1831. memset(f,0,sizeof(*f));
  1832. f->index = index;
  1833. f->type = type;
  1834. f->pixelformat = V4L2_PIX_FMT_GREY;
  1835. strcpy(f->description,"vbi data");
  1836. break;
  1837. default:
  1838. return -EINVAL;
  1839. }
  1840. return 0;
  1841. }
  1842. case VIDIOC_G_FBUF:
  1843. {
  1844. struct v4l2_framebuffer *fb = arg;
  1845. *fb = dev->ovbuf;
  1846. fb->capability = V4L2_FBUF_CAP_LIST_CLIPPING;
  1847. return 0;
  1848. }
  1849. case VIDIOC_S_FBUF:
  1850. {
  1851. struct v4l2_framebuffer *fb = arg;
  1852. struct saa7134_format *fmt;
  1853. if(!capable(CAP_SYS_ADMIN) &&
  1854. !capable(CAP_SYS_RAWIO))
  1855. return -EPERM;
  1856. /* check args */
  1857. fmt = format_by_fourcc(fb->fmt.pixelformat);
  1858. if (NULL == fmt)
  1859. return -EINVAL;
  1860. /* ok, accept it */
  1861. dev->ovbuf = *fb;
  1862. dev->ovfmt = fmt;
  1863. if (0 == dev->ovbuf.fmt.bytesperline)
  1864. dev->ovbuf.fmt.bytesperline =
  1865. dev->ovbuf.fmt.width*fmt->depth/8;
  1866. return 0;
  1867. }
  1868. case VIDIOC_OVERLAY:
  1869. {
  1870. int *on = arg;
  1871. if (*on) {
  1872. if (saa7134_no_overlay > 0) {
  1873. printk ("no_overlay\n");
  1874. return -EINVAL;
  1875. }
  1876. if (!res_get(dev,fh,RESOURCE_OVERLAY))
  1877. return -EBUSY;
  1878. spin_lock_irqsave(&dev->slock,flags);
  1879. start_preview(dev,fh);
  1880. spin_unlock_irqrestore(&dev->slock,flags);
  1881. }
  1882. if (!*on) {
  1883. if (!res_check(fh, RESOURCE_OVERLAY))
  1884. return -EINVAL;
  1885. spin_lock_irqsave(&dev->slock,flags);
  1886. stop_preview(dev,fh);
  1887. spin_unlock_irqrestore(&dev->slock,flags);
  1888. res_free(dev,fh,RESOURCE_OVERLAY);
  1889. }
  1890. return 0;
  1891. }
  1892. /* --- capture ioctls ---------------------------------------- */
  1893. case VIDIOC_G_FMT:
  1894. {
  1895. struct v4l2_format *f = arg;
  1896. return saa7134_g_fmt(dev,fh,f);
  1897. }
  1898. case VIDIOC_S_FMT:
  1899. {
  1900. struct v4l2_format *f = arg;
  1901. return saa7134_s_fmt(dev,fh,f);
  1902. }
  1903. case VIDIOC_TRY_FMT:
  1904. {
  1905. struct v4l2_format *f = arg;
  1906. return saa7134_try_fmt(dev,fh,f);
  1907. }
  1908. #ifdef CONFIG_VIDEO_V4L1_COMPAT
  1909. case VIDIOCGMBUF:
  1910. {
  1911. struct video_mbuf *mbuf = arg;
  1912. struct videobuf_queue *q;
  1913. struct v4l2_requestbuffers req;
  1914. unsigned int i;
  1915. q = saa7134_queue(fh);
  1916. memset(&req,0,sizeof(req));
  1917. req.type = q->type;
  1918. req.count = gbuffers;
  1919. req.memory = V4L2_MEMORY_MMAP;
  1920. err = videobuf_reqbufs(q,&req);
  1921. if (err < 0)
  1922. return err;
  1923. memset(mbuf,0,sizeof(*mbuf));
  1924. mbuf->frames = req.count;
  1925. mbuf->size = 0;
  1926. for (i = 0; i < mbuf->frames; i++) {
  1927. mbuf->offsets[i] = q->bufs[i]->boff;
  1928. mbuf->size += q->bufs[i]->bsize;
  1929. }
  1930. return 0;
  1931. }
  1932. #endif
  1933. case VIDIOC_REQBUFS:
  1934. return videobuf_reqbufs(saa7134_queue(fh),arg);
  1935. case VIDIOC_QUERYBUF:
  1936. return videobuf_querybuf(saa7134_queue(fh),arg);
  1937. case VIDIOC_QBUF:
  1938. return videobuf_qbuf(saa7134_queue(fh),arg);
  1939. case VIDIOC_DQBUF:
  1940. return videobuf_dqbuf(saa7134_queue(fh),arg,
  1941. file->f_flags & O_NONBLOCK);
  1942. case VIDIOC_STREAMON:
  1943. {
  1944. int res = saa7134_resource(fh);
  1945. if (!res_get(dev,fh,res))
  1946. return -EBUSY;
  1947. return videobuf_streamon(saa7134_queue(fh));
  1948. }
  1949. case VIDIOC_STREAMOFF:
  1950. {
  1951. int res = saa7134_resource(fh);
  1952. err = videobuf_streamoff(saa7134_queue(fh));
  1953. if (err < 0)
  1954. return err;
  1955. res_free(dev,fh,res);
  1956. return 0;
  1957. }
  1958. default:
  1959. return v4l_compat_translate_ioctl(inode,file,cmd,arg,
  1960. video_do_ioctl);
  1961. }
  1962. return 0;
  1963. }
  1964. static int video_ioctl(struct inode *inode, struct file *file,
  1965. unsigned int cmd, unsigned long arg)
  1966. {
  1967. return video_usercopy(inode, file, cmd, arg, video_do_ioctl);
  1968. }
  1969. static int radio_do_ioctl(struct inode *inode, struct file *file,
  1970. unsigned int cmd, void *arg)
  1971. {
  1972. struct saa7134_fh *fh = file->private_data;
  1973. struct saa7134_dev *dev = fh->dev;
  1974. if (video_debug > 1)
  1975. v4l_print_ioctl(dev->name,cmd);
  1976. switch (cmd) {
  1977. case VIDIOC_QUERYCAP:
  1978. {
  1979. struct v4l2_capability *cap = arg;
  1980. memset(cap,0,sizeof(*cap));
  1981. strcpy(cap->driver, "saa7134");
  1982. strlcpy(cap->card, saa7134_boards[dev->board].name,
  1983. sizeof(cap->card));
  1984. sprintf(cap->bus_info,"PCI:%s",pci_name(dev->pci));
  1985. cap->version = SAA7134_VERSION_CODE;
  1986. cap->capabilities = V4L2_CAP_TUNER;
  1987. return 0;
  1988. }
  1989. case VIDIOC_G_TUNER:
  1990. {
  1991. struct v4l2_tuner *t = arg;
  1992. if (0 != t->index)
  1993. return -EINVAL;
  1994. memset(t,0,sizeof(*t));
  1995. strcpy(t->name, "Radio");
  1996. t->type = V4L2_TUNER_RADIO;
  1997. saa7134_i2c_call_clients(dev, VIDIOC_G_TUNER, t);
  1998. if (dev->input->amux == TV) {
  1999. t->signal = 0xf800 - ((saa_readb(0x581) & 0x1f) << 11);
  2000. t->rxsubchans = (saa_readb(0x529) & 0x08) ?
  2001. V4L2_TUNER_SUB_STEREO : V4L2_TUNER_SUB_MONO;
  2002. }
  2003. return 0;
  2004. }
  2005. case VIDIOC_S_TUNER:
  2006. {
  2007. struct v4l2_tuner *t = arg;
  2008. if (0 != t->index)
  2009. return -EINVAL;
  2010. saa7134_i2c_call_clients(dev,VIDIOC_S_TUNER,t);
  2011. return 0;
  2012. }
  2013. case VIDIOC_ENUMINPUT:
  2014. {
  2015. struct v4l2_input *i = arg;
  2016. if (i->index != 0)
  2017. return -EINVAL;
  2018. strcpy(i->name,"Radio");
  2019. i->type = V4L2_INPUT_TYPE_TUNER;
  2020. return 0;
  2021. }
  2022. case VIDIOC_G_INPUT:
  2023. {
  2024. int *i = arg;
  2025. *i = 0;
  2026. return 0;
  2027. }
  2028. case VIDIOC_G_AUDIO:
  2029. {
  2030. struct v4l2_audio *a = arg;
  2031. memset(a,0,sizeof(*a));
  2032. strcpy(a->name,"Radio");
  2033. return 0;
  2034. }
  2035. case VIDIOC_G_STD:
  2036. {
  2037. v4l2_std_id *id = arg;
  2038. *id = 0;
  2039. return 0;
  2040. }
  2041. case VIDIOC_S_AUDIO:
  2042. case VIDIOC_S_INPUT:
  2043. case VIDIOC_S_STD:
  2044. return 0;
  2045. case VIDIOC_QUERYCTRL:
  2046. {
  2047. const struct v4l2_queryctrl *ctrl;
  2048. struct v4l2_queryctrl *c = arg;
  2049. if (c->id < V4L2_CID_BASE ||
  2050. c->id >= V4L2_CID_LASTP1)
  2051. return -EINVAL;
  2052. if (c->id == V4L2_CID_AUDIO_MUTE) {
  2053. ctrl = ctrl_by_id(c->id);
  2054. *c = *ctrl;
  2055. } else
  2056. *c = no_ctrl;
  2057. return 0;
  2058. }
  2059. case VIDIOC_G_CTRL:
  2060. case VIDIOC_S_CTRL:
  2061. case VIDIOC_G_FREQUENCY:
  2062. case VIDIOC_S_FREQUENCY:
  2063. return video_do_ioctl(inode,file,cmd,arg);
  2064. default:
  2065. return v4l_compat_translate_ioctl(inode,file,cmd,arg,
  2066. radio_do_ioctl);
  2067. }
  2068. return 0;
  2069. }
  2070. static int radio_ioctl(struct inode *inode, struct file *file,
  2071. unsigned int cmd, unsigned long arg)
  2072. {
  2073. return video_usercopy(inode, file, cmd, arg, radio_do_ioctl);
  2074. }
  2075. static const struct file_operations video_fops =
  2076. {
  2077. .owner = THIS_MODULE,
  2078. .open = video_open,
  2079. .release = video_release,
  2080. .read = video_read,
  2081. .poll = video_poll,
  2082. .mmap = video_mmap,
  2083. .ioctl = video_ioctl,
  2084. .compat_ioctl = v4l_compat_ioctl32,
  2085. .llseek = no_llseek,
  2086. };
  2087. static const struct file_operations radio_fops =
  2088. {
  2089. .owner = THIS_MODULE,
  2090. .open = video_open,
  2091. .release = video_release,
  2092. .ioctl = radio_ioctl,
  2093. .compat_ioctl = v4l_compat_ioctl32,
  2094. .llseek = no_llseek,
  2095. };
  2096. /* ----------------------------------------------------------- */
  2097. /* exported stuff */
  2098. struct video_device saa7134_video_template =
  2099. {
  2100. .name = "saa7134-video",
  2101. .type = VID_TYPE_CAPTURE|VID_TYPE_TUNER|
  2102. VID_TYPE_CLIPPING|VID_TYPE_SCALES,
  2103. .hardware = 0,
  2104. .fops = &video_fops,
  2105. .minor = -1,
  2106. };
  2107. struct video_device saa7134_vbi_template =
  2108. {
  2109. .name = "saa7134-vbi",
  2110. .type = VID_TYPE_TUNER|VID_TYPE_TELETEXT,
  2111. .hardware = 0,
  2112. .fops = &video_fops,
  2113. .minor = -1,
  2114. };
  2115. struct video_device saa7134_radio_template =
  2116. {
  2117. .name = "saa7134-radio",
  2118. .type = VID_TYPE_TUNER,
  2119. .hardware = 0,
  2120. .fops = &radio_fops,
  2121. .minor = -1,
  2122. };
  2123. int saa7134_video_init1(struct saa7134_dev *dev)
  2124. {
  2125. /* sanitycheck insmod options */
  2126. if (gbuffers < 2 || gbuffers > VIDEO_MAX_FRAME)
  2127. gbuffers = 2;
  2128. if (gbufsize < 0 || gbufsize > gbufsize_max)
  2129. gbufsize = gbufsize_max;
  2130. gbufsize = (gbufsize + PAGE_SIZE - 1) & PAGE_MASK;
  2131. /* put some sensible defaults into the data structures ... */
  2132. dev->ctl_bright = ctrl_by_id(V4L2_CID_BRIGHTNESS)->default_value;
  2133. dev->ctl_contrast = ctrl_by_id(V4L2_CID_CONTRAST)->default_value;
  2134. dev->ctl_hue = ctrl_by_id(V4L2_CID_HUE)->default_value;
  2135. dev->ctl_saturation = ctrl_by_id(V4L2_CID_SATURATION)->default_value;
  2136. dev->ctl_volume = ctrl_by_id(V4L2_CID_AUDIO_VOLUME)->default_value;
  2137. dev->ctl_mute = 1; // ctrl_by_id(V4L2_CID_AUDIO_MUTE)->default_value;
  2138. dev->ctl_invert = ctrl_by_id(V4L2_CID_PRIVATE_INVERT)->default_value;
  2139. dev->ctl_automute = ctrl_by_id(V4L2_CID_PRIVATE_AUTOMUTE)->default_value;
  2140. if (dev->tda9887_conf && dev->ctl_automute)
  2141. dev->tda9887_conf |= TDA9887_AUTOMUTE;
  2142. dev->automute = 0;
  2143. INIT_LIST_HEAD(&dev->video_q.queue);
  2144. init_timer(&dev->video_q.timeout);
  2145. dev->video_q.timeout.function = saa7134_buffer_timeout;
  2146. dev->video_q.timeout.data = (unsigned long)(&dev->video_q);
  2147. dev->video_q.dev = dev;
  2148. if (saa7134_boards[dev->board].video_out) {
  2149. /* enable video output */
  2150. int vo = saa7134_boards[dev->board].video_out;
  2151. int video_reg;
  2152. unsigned int vid_port_opts = saa7134_boards[dev->board].vid_port_opts;
  2153. saa_writeb(SAA7134_VIDEO_PORT_CTRL0, video_out[vo][0]);
  2154. video_reg = video_out[vo][1];
  2155. if (vid_port_opts & SET_T_CODE_POLARITY_NON_INVERTED)
  2156. video_reg &= ~VP_T_CODE_P_INVERTED;
  2157. saa_writeb(SAA7134_VIDEO_PORT_CTRL1, video_reg);
  2158. saa_writeb(SAA7134_VIDEO_PORT_CTRL2, video_out[vo][2]);
  2159. saa_writeb(SAA7134_VIDEO_PORT_CTRL3, video_out[vo][3]);
  2160. saa_writeb(SAA7134_VIDEO_PORT_CTRL4, video_out[vo][4]);
  2161. video_reg = video_out[vo][5];
  2162. if (vid_port_opts & SET_CLOCK_NOT_DELAYED)
  2163. video_reg &= ~VP_CLK_CTRL2_DELAYED;
  2164. if (vid_port_opts & SET_CLOCK_INVERTED)
  2165. video_reg |= VP_CLK_CTRL1_INVERTED;
  2166. saa_writeb(SAA7134_VIDEO_PORT_CTRL5, video_reg);
  2167. video_reg = video_out[vo][6];
  2168. if (vid_port_opts & SET_VSYNC_OFF) {
  2169. video_reg &= ~VP_VS_TYPE_MASK;
  2170. video_reg |= VP_VS_TYPE_OFF;
  2171. }
  2172. saa_writeb(SAA7134_VIDEO_PORT_CTRL6, video_reg);
  2173. saa_writeb(SAA7134_VIDEO_PORT_CTRL7, video_out[vo][7]);
  2174. saa_writeb(SAA7134_VIDEO_PORT_CTRL8, video_out[vo][8]);
  2175. }
  2176. return 0;
  2177. }
  2178. int saa7134_video_init2(struct saa7134_dev *dev)
  2179. {
  2180. /* init video hw */
  2181. set_tvnorm(dev,&tvnorms[0]);
  2182. video_mux(dev,0);
  2183. saa7134_tvaudio_setmute(dev);
  2184. saa7134_tvaudio_setvolume(dev,dev->ctl_volume);
  2185. return 0;
  2186. }
  2187. void saa7134_irq_video_intl(struct saa7134_dev *dev)
  2188. {
  2189. static const char *st[] = {
  2190. "(no signal)", "NTSC", "PAL", "SECAM" };
  2191. u32 st1,st2;
  2192. st1 = saa_readb(SAA7134_STATUS_VIDEO1);
  2193. st2 = saa_readb(SAA7134_STATUS_VIDEO2);
  2194. dprintk("DCSDT: pll: %s, sync: %s, norm: %s\n",
  2195. (st1 & 0x40) ? "not locked" : "locked",
  2196. (st2 & 0x40) ? "no" : "yes",
  2197. st[st1 & 0x03]);
  2198. dev->nosignal = (st1 & 0x40) || (st2 & 0x40);
  2199. if (dev->nosignal) {
  2200. /* no video signal -> mute audio */
  2201. if (dev->ctl_automute)
  2202. dev->automute = 1;
  2203. saa7134_tvaudio_setmute(dev);
  2204. saa_setb(SAA7134_SYNC_CTRL, 0x20);
  2205. } else {
  2206. /* wake up tvaudio audio carrier scan thread */
  2207. saa7134_tvaudio_do_scan(dev);
  2208. if (!noninterlaced)
  2209. saa_clearb(SAA7134_SYNC_CTRL, 0x20);
  2210. }
  2211. if (dev->mops && dev->mops->signal_change)
  2212. dev->mops->signal_change(dev);
  2213. }
  2214. void saa7134_irq_video_done(struct saa7134_dev *dev, unsigned long status)
  2215. {
  2216. enum v4l2_field field;
  2217. spin_lock(&dev->slock);
  2218. if (dev->video_q.curr) {
  2219. dev->video_fieldcount++;
  2220. field = dev->video_q.curr->vb.field;
  2221. if (V4L2_FIELD_HAS_BOTH(field)) {
  2222. /* make sure we have seen both fields */
  2223. if ((status & 0x10) == 0x00) {
  2224. dev->video_q.curr->top_seen = 1;
  2225. goto done;
  2226. }
  2227. if (!dev->video_q.curr->top_seen)
  2228. goto done;
  2229. } else if (field == V4L2_FIELD_TOP) {
  2230. if ((status & 0x10) != 0x10)
  2231. goto done;
  2232. } else if (field == V4L2_FIELD_BOTTOM) {
  2233. if ((status & 0x10) != 0x00)
  2234. goto done;
  2235. }
  2236. dev->video_q.curr->vb.field_count = dev->video_fieldcount;
  2237. saa7134_buffer_finish(dev,&dev->video_q,STATE_DONE);
  2238. }
  2239. saa7134_buffer_next(dev,&dev->video_q);
  2240. done:
  2241. spin_unlock(&dev->slock);
  2242. }
  2243. /* ----------------------------------------------------------- */
  2244. /*
  2245. * Local variables:
  2246. * c-basic-offset: 8
  2247. * End:
  2248. */