saa7134-video.c 63 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381238223832384238523862387238823892390239123922393239423952396239723982399240024012402240324042405240624072408240924102411241224132414241524162417241824192420242124222423242424252426242724282429243024312432243324342435243624372438243924402441244224432444244524462447244824492450245124522453245424552456245724582459246024612462246324642465246624672468246924702471247224732474247524762477247824792480248124822483248424852486248724882489249024912492249324942495249624972498249925002501250225032504250525062507250825092510251125122513251425152516251725182519252025212522252325242525252625272528252925302531253225332534253525362537
  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/moduleparam.h>
  26. #include <linux/kernel.h>
  27. #include <linux/slab.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
  461. int res_check(struct saa7134_fh *fh, unsigned int bit)
  462. {
  463. return (fh->resources & bit);
  464. }
  465. static
  466. int res_locked(struct saa7134_dev *dev, unsigned int bit)
  467. {
  468. return (dev->resources & bit);
  469. }
  470. static
  471. void res_free(struct saa7134_dev *dev, struct saa7134_fh *fh, unsigned int bits)
  472. {
  473. BUG_ON((fh->resources & bits) != bits);
  474. mutex_lock(&dev->lock);
  475. fh->resources &= ~bits;
  476. dev->resources &= ~bits;
  477. dprintk("res: put %d\n",bits);
  478. mutex_unlock(&dev->lock);
  479. }
  480. /* ------------------------------------------------------------------ */
  481. static void set_tvnorm(struct saa7134_dev *dev, struct saa7134_tvnorm *norm)
  482. {
  483. int luma_control,sync_control,mux;
  484. dprintk("set tv norm = %s\n",norm->name);
  485. dev->tvnorm = norm;
  486. mux = card_in(dev,dev->ctl_input).vmux;
  487. luma_control = norm->luma_control;
  488. sync_control = norm->sync_control;
  489. if (mux > 5)
  490. luma_control |= 0x80; /* svideo */
  491. if (noninterlaced || dev->nosignal)
  492. sync_control |= 0x20;
  493. /* setup cropping */
  494. dev->crop_bounds.left = norm->h_start;
  495. dev->crop_defrect.left = norm->h_start;
  496. dev->crop_bounds.width = norm->h_stop - norm->h_start +1;
  497. dev->crop_defrect.width = norm->h_stop - norm->h_start +1;
  498. dev->crop_bounds.top = (norm->vbi_v_stop_0+1)*2;
  499. dev->crop_defrect.top = norm->video_v_start*2;
  500. dev->crop_bounds.height = ((norm->id & V4L2_STD_525_60) ? 524 : 624)
  501. - dev->crop_bounds.top;
  502. dev->crop_defrect.height = (norm->video_v_stop - norm->video_v_start +1)*2;
  503. dev->crop_current = dev->crop_defrect;
  504. /* setup video decoder */
  505. saa_writeb(SAA7134_INCR_DELAY, 0x08);
  506. saa_writeb(SAA7134_ANALOG_IN_CTRL1, 0xc0 | mux);
  507. saa_writeb(SAA7134_ANALOG_IN_CTRL2, 0x00);
  508. saa_writeb(SAA7134_ANALOG_IN_CTRL3, 0x90);
  509. saa_writeb(SAA7134_ANALOG_IN_CTRL4, 0x90);
  510. saa_writeb(SAA7134_HSYNC_START, 0xeb);
  511. saa_writeb(SAA7134_HSYNC_STOP, 0xe0);
  512. saa_writeb(SAA7134_SOURCE_TIMING1, norm->src_timing);
  513. saa_writeb(SAA7134_SYNC_CTRL, sync_control);
  514. saa_writeb(SAA7134_LUMA_CTRL, luma_control);
  515. saa_writeb(SAA7134_DEC_LUMA_BRIGHT, dev->ctl_bright);
  516. saa_writeb(SAA7134_DEC_LUMA_CONTRAST, dev->ctl_contrast);
  517. saa_writeb(SAA7134_DEC_CHROMA_SATURATION, dev->ctl_saturation);
  518. saa_writeb(SAA7134_DEC_CHROMA_HUE, dev->ctl_hue);
  519. saa_writeb(SAA7134_CHROMA_CTRL1, norm->chroma_ctrl1);
  520. saa_writeb(SAA7134_CHROMA_GAIN, norm->chroma_gain);
  521. saa_writeb(SAA7134_CHROMA_CTRL2, norm->chroma_ctrl2);
  522. saa_writeb(SAA7134_MODE_DELAY_CTRL, 0x00);
  523. saa_writeb(SAA7134_ANALOG_ADC, 0x01);
  524. saa_writeb(SAA7134_VGATE_START, 0x11);
  525. saa_writeb(SAA7134_VGATE_STOP, 0xfe);
  526. saa_writeb(SAA7134_MISC_VGATE_MSB, norm->vgate_misc);
  527. saa_writeb(SAA7134_RAW_DATA_GAIN, 0x40);
  528. saa_writeb(SAA7134_RAW_DATA_OFFSET, 0x80);
  529. saa7134_i2c_call_clients(dev,VIDIOC_S_STD,&norm->id);
  530. }
  531. static void video_mux(struct saa7134_dev *dev, int input)
  532. {
  533. dprintk("video input = %d [%s]\n",input,card_in(dev,input).name);
  534. dev->ctl_input = input;
  535. set_tvnorm(dev,dev->tvnorm);
  536. saa7134_tvaudio_setinput(dev,&card_in(dev,input));
  537. }
  538. static void set_h_prescale(struct saa7134_dev *dev, int task, int prescale)
  539. {
  540. static const struct {
  541. int xpsc;
  542. int xacl;
  543. int xc2_1;
  544. int xdcg;
  545. int vpfy;
  546. } vals[] = {
  547. /* XPSC XACL XC2_1 XDCG VPFY */
  548. { 1, 0, 0, 0, 0 },
  549. { 2, 2, 1, 2, 2 },
  550. { 3, 4, 1, 3, 2 },
  551. { 4, 8, 1, 4, 2 },
  552. { 5, 8, 1, 4, 2 },
  553. { 6, 8, 1, 4, 3 },
  554. { 7, 8, 1, 4, 3 },
  555. { 8, 15, 0, 4, 3 },
  556. { 9, 15, 0, 4, 3 },
  557. { 10, 16, 1, 5, 3 },
  558. };
  559. static const int count = ARRAY_SIZE(vals);
  560. int i;
  561. for (i = 0; i < count; i++)
  562. if (vals[i].xpsc == prescale)
  563. break;
  564. if (i == count)
  565. return;
  566. saa_writeb(SAA7134_H_PRESCALE(task), vals[i].xpsc);
  567. saa_writeb(SAA7134_ACC_LENGTH(task), vals[i].xacl);
  568. saa_writeb(SAA7134_LEVEL_CTRL(task),
  569. (vals[i].xc2_1 << 3) | (vals[i].xdcg));
  570. saa_andorb(SAA7134_FIR_PREFILTER_CTRL(task), 0x0f,
  571. (vals[i].vpfy << 2) | vals[i].vpfy);
  572. }
  573. static void set_v_scale(struct saa7134_dev *dev, int task, int yscale)
  574. {
  575. int val,mirror;
  576. saa_writeb(SAA7134_V_SCALE_RATIO1(task), yscale & 0xff);
  577. saa_writeb(SAA7134_V_SCALE_RATIO2(task), yscale >> 8);
  578. mirror = (dev->ctl_mirror) ? 0x02 : 0x00;
  579. if (yscale < 2048) {
  580. /* LPI */
  581. dprintk("yscale LPI yscale=%d\n",yscale);
  582. saa_writeb(SAA7134_V_FILTER(task), 0x00 | mirror);
  583. saa_writeb(SAA7134_LUMA_CONTRAST(task), 0x40);
  584. saa_writeb(SAA7134_CHROMA_SATURATION(task), 0x40);
  585. } else {
  586. /* ACM */
  587. val = 0x40 * 1024 / yscale;
  588. dprintk("yscale ACM yscale=%d val=0x%x\n",yscale,val);
  589. saa_writeb(SAA7134_V_FILTER(task), 0x01 | mirror);
  590. saa_writeb(SAA7134_LUMA_CONTRAST(task), val);
  591. saa_writeb(SAA7134_CHROMA_SATURATION(task), val);
  592. }
  593. saa_writeb(SAA7134_LUMA_BRIGHT(task), 0x80);
  594. }
  595. static void set_size(struct saa7134_dev *dev, int task,
  596. int width, int height, int interlace)
  597. {
  598. int prescale,xscale,yscale,y_even,y_odd;
  599. int h_start, h_stop, v_start, v_stop;
  600. int div = interlace ? 2 : 1;
  601. /* setup video scaler */
  602. h_start = dev->crop_current.left;
  603. v_start = dev->crop_current.top/2;
  604. h_stop = (dev->crop_current.left + dev->crop_current.width -1);
  605. v_stop = (dev->crop_current.top + dev->crop_current.height -1)/2;
  606. saa_writeb(SAA7134_VIDEO_H_START1(task), h_start & 0xff);
  607. saa_writeb(SAA7134_VIDEO_H_START2(task), h_start >> 8);
  608. saa_writeb(SAA7134_VIDEO_H_STOP1(task), h_stop & 0xff);
  609. saa_writeb(SAA7134_VIDEO_H_STOP2(task), h_stop >> 8);
  610. saa_writeb(SAA7134_VIDEO_V_START1(task), v_start & 0xff);
  611. saa_writeb(SAA7134_VIDEO_V_START2(task), v_start >> 8);
  612. saa_writeb(SAA7134_VIDEO_V_STOP1(task), v_stop & 0xff);
  613. saa_writeb(SAA7134_VIDEO_V_STOP2(task), v_stop >> 8);
  614. prescale = dev->crop_current.width / width;
  615. if (0 == prescale)
  616. prescale = 1;
  617. xscale = 1024 * dev->crop_current.width / prescale / width;
  618. yscale = 512 * div * dev->crop_current.height / height;
  619. dprintk("prescale=%d xscale=%d yscale=%d\n",prescale,xscale,yscale);
  620. set_h_prescale(dev,task,prescale);
  621. saa_writeb(SAA7134_H_SCALE_INC1(task), xscale & 0xff);
  622. saa_writeb(SAA7134_H_SCALE_INC2(task), xscale >> 8);
  623. set_v_scale(dev,task,yscale);
  624. saa_writeb(SAA7134_VIDEO_PIXELS1(task), width & 0xff);
  625. saa_writeb(SAA7134_VIDEO_PIXELS2(task), width >> 8);
  626. saa_writeb(SAA7134_VIDEO_LINES1(task), height/div & 0xff);
  627. saa_writeb(SAA7134_VIDEO_LINES2(task), height/div >> 8);
  628. /* deinterlace y offsets */
  629. y_odd = dev->ctl_y_odd;
  630. y_even = dev->ctl_y_even;
  631. saa_writeb(SAA7134_V_PHASE_OFFSET0(task), y_odd);
  632. saa_writeb(SAA7134_V_PHASE_OFFSET1(task), y_even);
  633. saa_writeb(SAA7134_V_PHASE_OFFSET2(task), y_odd);
  634. saa_writeb(SAA7134_V_PHASE_OFFSET3(task), y_even);
  635. }
  636. /* ------------------------------------------------------------------ */
  637. struct cliplist {
  638. __u16 position;
  639. __u8 enable;
  640. __u8 disable;
  641. };
  642. static void sort_cliplist(struct cliplist *cl, int entries)
  643. {
  644. struct cliplist swap;
  645. int i,j,n;
  646. for (i = entries-2; i >= 0; i--) {
  647. for (n = 0, j = 0; j <= i; j++) {
  648. if (cl[j].position > cl[j+1].position) {
  649. swap = cl[j];
  650. cl[j] = cl[j+1];
  651. cl[j+1] = swap;
  652. n++;
  653. }
  654. }
  655. if (0 == n)
  656. break;
  657. }
  658. }
  659. static void set_cliplist(struct saa7134_dev *dev, int reg,
  660. struct cliplist *cl, int entries, char *name)
  661. {
  662. __u8 winbits = 0;
  663. int i;
  664. for (i = 0; i < entries; i++) {
  665. winbits |= cl[i].enable;
  666. winbits &= ~cl[i].disable;
  667. if (i < 15 && cl[i].position == cl[i+1].position)
  668. continue;
  669. saa_writeb(reg + 0, winbits);
  670. saa_writeb(reg + 2, cl[i].position & 0xff);
  671. saa_writeb(reg + 3, cl[i].position >> 8);
  672. dprintk("clip: %s winbits=%02x pos=%d\n",
  673. name,winbits,cl[i].position);
  674. reg += 8;
  675. }
  676. for (; reg < 0x400; reg += 8) {
  677. saa_writeb(reg+ 0, 0);
  678. saa_writeb(reg + 1, 0);
  679. saa_writeb(reg + 2, 0);
  680. saa_writeb(reg + 3, 0);
  681. }
  682. }
  683. static int clip_range(int val)
  684. {
  685. if (val < 0)
  686. val = 0;
  687. return val;
  688. }
  689. static int setup_clipping(struct saa7134_dev *dev, struct v4l2_clip *clips,
  690. int nclips, int interlace)
  691. {
  692. struct cliplist col[16], row[16];
  693. int cols, rows, i;
  694. int div = interlace ? 2 : 1;
  695. memset(col,0,sizeof(col)); cols = 0;
  696. memset(row,0,sizeof(row)); rows = 0;
  697. for (i = 0; i < nclips && i < 8; i++) {
  698. col[cols].position = clip_range(clips[i].c.left);
  699. col[cols].enable = (1 << i);
  700. cols++;
  701. col[cols].position = clip_range(clips[i].c.left+clips[i].c.width);
  702. col[cols].disable = (1 << i);
  703. cols++;
  704. row[rows].position = clip_range(clips[i].c.top / div);
  705. row[rows].enable = (1 << i);
  706. rows++;
  707. row[rows].position = clip_range((clips[i].c.top + clips[i].c.height)
  708. / div);
  709. row[rows].disable = (1 << i);
  710. rows++;
  711. }
  712. sort_cliplist(col,cols);
  713. sort_cliplist(row,rows);
  714. set_cliplist(dev,0x380,col,cols,"cols");
  715. set_cliplist(dev,0x384,row,rows,"rows");
  716. return 0;
  717. }
  718. static int verify_preview(struct saa7134_dev *dev, struct v4l2_window *win)
  719. {
  720. enum v4l2_field field;
  721. int maxw, maxh;
  722. if (NULL == dev->ovbuf.base)
  723. return -EINVAL;
  724. if (NULL == dev->ovfmt)
  725. return -EINVAL;
  726. if (win->w.width < 48 || win->w.height < 32)
  727. return -EINVAL;
  728. if (win->clipcount > 2048)
  729. return -EINVAL;
  730. field = win->field;
  731. maxw = dev->crop_current.width;
  732. maxh = dev->crop_current.height;
  733. if (V4L2_FIELD_ANY == field) {
  734. field = (win->w.height > maxh/2)
  735. ? V4L2_FIELD_INTERLACED
  736. : V4L2_FIELD_TOP;
  737. }
  738. switch (field) {
  739. case V4L2_FIELD_TOP:
  740. case V4L2_FIELD_BOTTOM:
  741. maxh = maxh / 2;
  742. break;
  743. case V4L2_FIELD_INTERLACED:
  744. break;
  745. default:
  746. return -EINVAL;
  747. }
  748. win->field = field;
  749. if (win->w.width > maxw)
  750. win->w.width = maxw;
  751. if (win->w.height > maxh)
  752. win->w.height = maxh;
  753. return 0;
  754. }
  755. static int start_preview(struct saa7134_dev *dev, struct saa7134_fh *fh)
  756. {
  757. unsigned long base,control,bpl;
  758. int err;
  759. err = verify_preview(dev,&fh->win);
  760. if (0 != err)
  761. return err;
  762. dev->ovfield = fh->win.field;
  763. dprintk("start_preview %dx%d+%d+%d %s field=%s\n",
  764. fh->win.w.width,fh->win.w.height,
  765. fh->win.w.left,fh->win.w.top,
  766. dev->ovfmt->name,v4l2_field_names[dev->ovfield]);
  767. /* setup window + clipping */
  768. set_size(dev,TASK_B,fh->win.w.width,fh->win.w.height,
  769. V4L2_FIELD_HAS_BOTH(dev->ovfield));
  770. setup_clipping(dev,fh->clips,fh->nclips,
  771. V4L2_FIELD_HAS_BOTH(dev->ovfield));
  772. if (dev->ovfmt->yuv)
  773. saa_andorb(SAA7134_DATA_PATH(TASK_B), 0x3f, 0x03);
  774. else
  775. saa_andorb(SAA7134_DATA_PATH(TASK_B), 0x3f, 0x01);
  776. saa_writeb(SAA7134_OFMT_VIDEO_B, dev->ovfmt->pm | 0x20);
  777. /* dma: setup channel 1 (= Video Task B) */
  778. base = (unsigned long)dev->ovbuf.base;
  779. base += dev->ovbuf.fmt.bytesperline * fh->win.w.top;
  780. base += dev->ovfmt->depth/8 * fh->win.w.left;
  781. bpl = dev->ovbuf.fmt.bytesperline;
  782. control = SAA7134_RS_CONTROL_BURST_16;
  783. if (dev->ovfmt->bswap)
  784. control |= SAA7134_RS_CONTROL_BSWAP;
  785. if (dev->ovfmt->wswap)
  786. control |= SAA7134_RS_CONTROL_WSWAP;
  787. if (V4L2_FIELD_HAS_BOTH(dev->ovfield)) {
  788. saa_writel(SAA7134_RS_BA1(1),base);
  789. saa_writel(SAA7134_RS_BA2(1),base+bpl);
  790. saa_writel(SAA7134_RS_PITCH(1),bpl*2);
  791. saa_writel(SAA7134_RS_CONTROL(1),control);
  792. } else {
  793. saa_writel(SAA7134_RS_BA1(1),base);
  794. saa_writel(SAA7134_RS_BA2(1),base);
  795. saa_writel(SAA7134_RS_PITCH(1),bpl);
  796. saa_writel(SAA7134_RS_CONTROL(1),control);
  797. }
  798. /* start dma */
  799. dev->ovenable = 1;
  800. saa7134_set_dmabits(dev);
  801. return 0;
  802. }
  803. static int stop_preview(struct saa7134_dev *dev, struct saa7134_fh *fh)
  804. {
  805. dev->ovenable = 0;
  806. saa7134_set_dmabits(dev);
  807. return 0;
  808. }
  809. /* ------------------------------------------------------------------ */
  810. static int buffer_activate(struct saa7134_dev *dev,
  811. struct saa7134_buf *buf,
  812. struct saa7134_buf *next)
  813. {
  814. unsigned long base,control,bpl;
  815. unsigned long bpl_uv,lines_uv,base2,base3,tmp; /* planar */
  816. dprintk("buffer_activate buf=%p\n",buf);
  817. buf->vb.state = STATE_ACTIVE;
  818. buf->top_seen = 0;
  819. set_size(dev,TASK_A,buf->vb.width,buf->vb.height,
  820. V4L2_FIELD_HAS_BOTH(buf->vb.field));
  821. if (buf->fmt->yuv)
  822. saa_andorb(SAA7134_DATA_PATH(TASK_A), 0x3f, 0x03);
  823. else
  824. saa_andorb(SAA7134_DATA_PATH(TASK_A), 0x3f, 0x01);
  825. saa_writeb(SAA7134_OFMT_VIDEO_A, buf->fmt->pm);
  826. /* DMA: setup channel 0 (= Video Task A0) */
  827. base = saa7134_buffer_base(buf);
  828. if (buf->fmt->planar)
  829. bpl = buf->vb.width;
  830. else
  831. bpl = (buf->vb.width * buf->fmt->depth) / 8;
  832. control = SAA7134_RS_CONTROL_BURST_16 |
  833. SAA7134_RS_CONTROL_ME |
  834. (buf->pt->dma >> 12);
  835. if (buf->fmt->bswap)
  836. control |= SAA7134_RS_CONTROL_BSWAP;
  837. if (buf->fmt->wswap)
  838. control |= SAA7134_RS_CONTROL_WSWAP;
  839. if (V4L2_FIELD_HAS_BOTH(buf->vb.field)) {
  840. /* interlaced */
  841. saa_writel(SAA7134_RS_BA1(0),base);
  842. saa_writel(SAA7134_RS_BA2(0),base+bpl);
  843. saa_writel(SAA7134_RS_PITCH(0),bpl*2);
  844. } else {
  845. /* non-interlaced */
  846. saa_writel(SAA7134_RS_BA1(0),base);
  847. saa_writel(SAA7134_RS_BA2(0),base);
  848. saa_writel(SAA7134_RS_PITCH(0),bpl);
  849. }
  850. saa_writel(SAA7134_RS_CONTROL(0),control);
  851. if (buf->fmt->planar) {
  852. /* DMA: setup channel 4+5 (= planar task A) */
  853. bpl_uv = bpl >> buf->fmt->hshift;
  854. lines_uv = buf->vb.height >> buf->fmt->vshift;
  855. base2 = base + bpl * buf->vb.height;
  856. base3 = base2 + bpl_uv * lines_uv;
  857. if (buf->fmt->uvswap)
  858. tmp = base2, base2 = base3, base3 = tmp;
  859. dprintk("uv: bpl=%ld lines=%ld base2/3=%ld/%ld\n",
  860. bpl_uv,lines_uv,base2,base3);
  861. if (V4L2_FIELD_HAS_BOTH(buf->vb.field)) {
  862. /* interlaced */
  863. saa_writel(SAA7134_RS_BA1(4),base2);
  864. saa_writel(SAA7134_RS_BA2(4),base2+bpl_uv);
  865. saa_writel(SAA7134_RS_PITCH(4),bpl_uv*2);
  866. saa_writel(SAA7134_RS_BA1(5),base3);
  867. saa_writel(SAA7134_RS_BA2(5),base3+bpl_uv);
  868. saa_writel(SAA7134_RS_PITCH(5),bpl_uv*2);
  869. } else {
  870. /* non-interlaced */
  871. saa_writel(SAA7134_RS_BA1(4),base2);
  872. saa_writel(SAA7134_RS_BA2(4),base2);
  873. saa_writel(SAA7134_RS_PITCH(4),bpl_uv);
  874. saa_writel(SAA7134_RS_BA1(5),base3);
  875. saa_writel(SAA7134_RS_BA2(5),base3);
  876. saa_writel(SAA7134_RS_PITCH(5),bpl_uv);
  877. }
  878. saa_writel(SAA7134_RS_CONTROL(4),control);
  879. saa_writel(SAA7134_RS_CONTROL(5),control);
  880. }
  881. /* start DMA */
  882. saa7134_set_dmabits(dev);
  883. mod_timer(&dev->video_q.timeout, jiffies+BUFFER_TIMEOUT);
  884. return 0;
  885. }
  886. static int buffer_prepare(struct videobuf_queue *q,
  887. struct videobuf_buffer *vb,
  888. enum v4l2_field field)
  889. {
  890. struct saa7134_fh *fh = q->priv_data;
  891. struct saa7134_dev *dev = fh->dev;
  892. struct saa7134_buf *buf = container_of(vb,struct saa7134_buf,vb);
  893. unsigned int size;
  894. int err;
  895. /* sanity checks */
  896. if (NULL == fh->fmt)
  897. return -EINVAL;
  898. if (fh->width < 48 ||
  899. fh->height < 32 ||
  900. fh->width/4 > dev->crop_current.width ||
  901. fh->height/4 > dev->crop_current.height ||
  902. fh->width > dev->crop_bounds.width ||
  903. fh->height > dev->crop_bounds.height)
  904. return -EINVAL;
  905. size = (fh->width * fh->height * fh->fmt->depth) >> 3;
  906. if (0 != buf->vb.baddr && buf->vb.bsize < size)
  907. return -EINVAL;
  908. dprintk("buffer_prepare [%d,size=%dx%d,bytes=%d,fields=%s,%s]\n",
  909. vb->i,fh->width,fh->height,size,v4l2_field_names[field],
  910. fh->fmt->name);
  911. if (buf->vb.width != fh->width ||
  912. buf->vb.height != fh->height ||
  913. buf->vb.size != size ||
  914. buf->vb.field != field ||
  915. buf->fmt != fh->fmt) {
  916. saa7134_dma_free(q,buf);
  917. }
  918. if (STATE_NEEDS_INIT == buf->vb.state) {
  919. buf->vb.width = fh->width;
  920. buf->vb.height = fh->height;
  921. buf->vb.size = size;
  922. buf->vb.field = field;
  923. buf->fmt = fh->fmt;
  924. buf->pt = &fh->pt_cap;
  925. err = videobuf_iolock(q,&buf->vb,&dev->ovbuf);
  926. if (err)
  927. goto oops;
  928. err = saa7134_pgtable_build(dev->pci,buf->pt,
  929. buf->vb.dma.sglist,
  930. buf->vb.dma.sglen,
  931. saa7134_buffer_startpage(buf));
  932. if (err)
  933. goto oops;
  934. }
  935. buf->vb.state = STATE_PREPARED;
  936. buf->activate = buffer_activate;
  937. return 0;
  938. oops:
  939. saa7134_dma_free(q,buf);
  940. return err;
  941. }
  942. static int
  943. buffer_setup(struct videobuf_queue *q, unsigned int *count, unsigned int *size)
  944. {
  945. struct saa7134_fh *fh = q->priv_data;
  946. *size = fh->fmt->depth * fh->width * fh->height >> 3;
  947. if (0 == *count)
  948. *count = gbuffers;
  949. *count = saa7134_buffer_count(*size,*count);
  950. return 0;
  951. }
  952. static void buffer_queue(struct videobuf_queue *q, struct videobuf_buffer *vb)
  953. {
  954. struct saa7134_fh *fh = q->priv_data;
  955. struct saa7134_buf *buf = container_of(vb,struct saa7134_buf,vb);
  956. saa7134_buffer_queue(fh->dev,&fh->dev->video_q,buf);
  957. }
  958. static void buffer_release(struct videobuf_queue *q, struct videobuf_buffer *vb)
  959. {
  960. struct saa7134_buf *buf = container_of(vb,struct saa7134_buf,vb);
  961. saa7134_dma_free(q,buf);
  962. }
  963. static struct videobuf_queue_ops video_qops = {
  964. .buf_setup = buffer_setup,
  965. .buf_prepare = buffer_prepare,
  966. .buf_queue = buffer_queue,
  967. .buf_release = buffer_release,
  968. };
  969. /* ------------------------------------------------------------------ */
  970. static int get_control(struct saa7134_dev *dev, struct v4l2_control *c)
  971. {
  972. const struct v4l2_queryctrl* ctrl;
  973. ctrl = ctrl_by_id(c->id);
  974. if (NULL == ctrl)
  975. return -EINVAL;
  976. switch (c->id) {
  977. case V4L2_CID_BRIGHTNESS:
  978. c->value = dev->ctl_bright;
  979. break;
  980. case V4L2_CID_HUE:
  981. c->value = dev->ctl_hue;
  982. break;
  983. case V4L2_CID_CONTRAST:
  984. c->value = dev->ctl_contrast;
  985. break;
  986. case V4L2_CID_SATURATION:
  987. c->value = dev->ctl_saturation;
  988. break;
  989. case V4L2_CID_AUDIO_MUTE:
  990. c->value = dev->ctl_mute;
  991. break;
  992. case V4L2_CID_AUDIO_VOLUME:
  993. c->value = dev->ctl_volume;
  994. break;
  995. case V4L2_CID_PRIVATE_INVERT:
  996. c->value = dev->ctl_invert;
  997. break;
  998. case V4L2_CID_HFLIP:
  999. c->value = dev->ctl_mirror;
  1000. break;
  1001. case V4L2_CID_PRIVATE_Y_EVEN:
  1002. c->value = dev->ctl_y_even;
  1003. break;
  1004. case V4L2_CID_PRIVATE_Y_ODD:
  1005. c->value = dev->ctl_y_odd;
  1006. break;
  1007. case V4L2_CID_PRIVATE_AUTOMUTE:
  1008. c->value = dev->ctl_automute;
  1009. break;
  1010. default:
  1011. return -EINVAL;
  1012. }
  1013. return 0;
  1014. }
  1015. static int set_control(struct saa7134_dev *dev, struct saa7134_fh *fh,
  1016. struct v4l2_control *c)
  1017. {
  1018. const struct v4l2_queryctrl* ctrl;
  1019. unsigned long flags;
  1020. int restart_overlay = 0;
  1021. ctrl = ctrl_by_id(c->id);
  1022. if (NULL == ctrl)
  1023. return -EINVAL;
  1024. dprintk("set_control name=%s val=%d\n",ctrl->name,c->value);
  1025. switch (ctrl->type) {
  1026. case V4L2_CTRL_TYPE_BOOLEAN:
  1027. case V4L2_CTRL_TYPE_MENU:
  1028. case V4L2_CTRL_TYPE_INTEGER:
  1029. if (c->value < ctrl->minimum)
  1030. c->value = ctrl->minimum;
  1031. if (c->value > ctrl->maximum)
  1032. c->value = ctrl->maximum;
  1033. break;
  1034. default:
  1035. /* nothing */;
  1036. };
  1037. switch (c->id) {
  1038. case V4L2_CID_BRIGHTNESS:
  1039. dev->ctl_bright = c->value;
  1040. saa_writeb(SAA7134_DEC_LUMA_BRIGHT, dev->ctl_bright);
  1041. break;
  1042. case V4L2_CID_HUE:
  1043. dev->ctl_hue = c->value;
  1044. saa_writeb(SAA7134_DEC_CHROMA_HUE, dev->ctl_hue);
  1045. break;
  1046. case V4L2_CID_CONTRAST:
  1047. dev->ctl_contrast = c->value;
  1048. saa_writeb(SAA7134_DEC_LUMA_CONTRAST,
  1049. dev->ctl_invert ? -dev->ctl_contrast : dev->ctl_contrast);
  1050. break;
  1051. case V4L2_CID_SATURATION:
  1052. dev->ctl_saturation = c->value;
  1053. saa_writeb(SAA7134_DEC_CHROMA_SATURATION,
  1054. dev->ctl_invert ? -dev->ctl_saturation : dev->ctl_saturation);
  1055. break;
  1056. case V4L2_CID_AUDIO_MUTE:
  1057. dev->ctl_mute = c->value;
  1058. saa7134_tvaudio_setmute(dev);
  1059. break;
  1060. case V4L2_CID_AUDIO_VOLUME:
  1061. dev->ctl_volume = c->value;
  1062. saa7134_tvaudio_setvolume(dev,dev->ctl_volume);
  1063. break;
  1064. case V4L2_CID_PRIVATE_INVERT:
  1065. dev->ctl_invert = c->value;
  1066. saa_writeb(SAA7134_DEC_LUMA_CONTRAST,
  1067. dev->ctl_invert ? -dev->ctl_contrast : dev->ctl_contrast);
  1068. saa_writeb(SAA7134_DEC_CHROMA_SATURATION,
  1069. dev->ctl_invert ? -dev->ctl_saturation : dev->ctl_saturation);
  1070. break;
  1071. case V4L2_CID_HFLIP:
  1072. dev->ctl_mirror = c->value;
  1073. restart_overlay = 1;
  1074. break;
  1075. case V4L2_CID_PRIVATE_Y_EVEN:
  1076. dev->ctl_y_even = c->value;
  1077. restart_overlay = 1;
  1078. break;
  1079. case V4L2_CID_PRIVATE_Y_ODD:
  1080. dev->ctl_y_odd = c->value;
  1081. restart_overlay = 1;
  1082. break;
  1083. case V4L2_CID_PRIVATE_AUTOMUTE:
  1084. dev->ctl_automute = c->value;
  1085. if (dev->tda9887_conf) {
  1086. if (dev->ctl_automute)
  1087. dev->tda9887_conf |= TDA9887_AUTOMUTE;
  1088. else
  1089. dev->tda9887_conf &= ~TDA9887_AUTOMUTE;
  1090. saa7134_i2c_call_clients(dev, TDA9887_SET_CONFIG,
  1091. &dev->tda9887_conf);
  1092. }
  1093. break;
  1094. default:
  1095. return -EINVAL;
  1096. }
  1097. if (restart_overlay && fh && res_check(fh, RESOURCE_OVERLAY)) {
  1098. spin_lock_irqsave(&dev->slock,flags);
  1099. stop_preview(dev,fh);
  1100. start_preview(dev,fh);
  1101. spin_unlock_irqrestore(&dev->slock,flags);
  1102. }
  1103. return 0;
  1104. }
  1105. /* ------------------------------------------------------------------ */
  1106. static struct videobuf_queue* saa7134_queue(struct saa7134_fh *fh)
  1107. {
  1108. struct videobuf_queue* q = NULL;
  1109. switch (fh->type) {
  1110. case V4L2_BUF_TYPE_VIDEO_CAPTURE:
  1111. q = &fh->cap;
  1112. break;
  1113. case V4L2_BUF_TYPE_VBI_CAPTURE:
  1114. q = &fh->vbi;
  1115. break;
  1116. default:
  1117. BUG();
  1118. }
  1119. return q;
  1120. }
  1121. static int saa7134_resource(struct saa7134_fh *fh)
  1122. {
  1123. int res = 0;
  1124. switch (fh->type) {
  1125. case V4L2_BUF_TYPE_VIDEO_CAPTURE:
  1126. res = RESOURCE_VIDEO;
  1127. break;
  1128. case V4L2_BUF_TYPE_VBI_CAPTURE:
  1129. res = RESOURCE_VBI;
  1130. break;
  1131. default:
  1132. BUG();
  1133. }
  1134. return res;
  1135. }
  1136. static int video_open(struct inode *inode, struct file *file)
  1137. {
  1138. int minor = iminor(inode);
  1139. struct saa7134_dev *h,*dev = NULL;
  1140. struct saa7134_fh *fh;
  1141. struct list_head *list;
  1142. enum v4l2_buf_type type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
  1143. int radio = 0;
  1144. list_for_each(list,&saa7134_devlist) {
  1145. h = list_entry(list, struct saa7134_dev, devlist);
  1146. if (h->video_dev && (h->video_dev->minor == minor))
  1147. dev = h;
  1148. if (h->radio_dev && (h->radio_dev->minor == minor)) {
  1149. radio = 1;
  1150. dev = h;
  1151. }
  1152. if (h->vbi_dev && (h->vbi_dev->minor == minor)) {
  1153. type = V4L2_BUF_TYPE_VBI_CAPTURE;
  1154. dev = h;
  1155. }
  1156. }
  1157. if (NULL == dev)
  1158. return -ENODEV;
  1159. dprintk("open minor=%d radio=%d type=%s\n",minor,radio,
  1160. v4l2_type_names[type]);
  1161. /* allocate + initialize per filehandle data */
  1162. fh = kzalloc(sizeof(*fh),GFP_KERNEL);
  1163. if (NULL == fh)
  1164. return -ENOMEM;
  1165. file->private_data = fh;
  1166. fh->dev = dev;
  1167. fh->radio = radio;
  1168. fh->type = type;
  1169. fh->fmt = format_by_fourcc(V4L2_PIX_FMT_BGR24);
  1170. fh->width = 720;
  1171. fh->height = 576;
  1172. v4l2_prio_open(&dev->prio,&fh->prio);
  1173. videobuf_queue_init(&fh->cap, &video_qops,
  1174. dev->pci, &dev->slock,
  1175. V4L2_BUF_TYPE_VIDEO_CAPTURE,
  1176. V4L2_FIELD_INTERLACED,
  1177. sizeof(struct saa7134_buf),
  1178. fh);
  1179. videobuf_queue_init(&fh->vbi, &saa7134_vbi_qops,
  1180. dev->pci, &dev->slock,
  1181. V4L2_BUF_TYPE_VBI_CAPTURE,
  1182. V4L2_FIELD_SEQ_TB,
  1183. sizeof(struct saa7134_buf),
  1184. fh);
  1185. saa7134_pgtable_alloc(dev->pci,&fh->pt_cap);
  1186. saa7134_pgtable_alloc(dev->pci,&fh->pt_vbi);
  1187. if (fh->radio) {
  1188. /* switch to radio mode */
  1189. saa7134_tvaudio_setinput(dev,&card(dev).radio);
  1190. saa7134_i2c_call_clients(dev,AUDC_SET_RADIO, NULL);
  1191. } else {
  1192. /* switch to video/vbi mode */
  1193. video_mux(dev,dev->ctl_input);
  1194. }
  1195. return 0;
  1196. }
  1197. static ssize_t
  1198. video_read(struct file *file, char __user *data, size_t count, loff_t *ppos)
  1199. {
  1200. struct saa7134_fh *fh = file->private_data;
  1201. switch (fh->type) {
  1202. case V4L2_BUF_TYPE_VIDEO_CAPTURE:
  1203. if (res_locked(fh->dev,RESOURCE_VIDEO))
  1204. return -EBUSY;
  1205. return videobuf_read_one(saa7134_queue(fh),
  1206. data, count, ppos,
  1207. file->f_flags & O_NONBLOCK);
  1208. case V4L2_BUF_TYPE_VBI_CAPTURE:
  1209. if (!res_get(fh->dev,fh,RESOURCE_VBI))
  1210. return -EBUSY;
  1211. return videobuf_read_stream(saa7134_queue(fh),
  1212. data, count, ppos, 1,
  1213. file->f_flags & O_NONBLOCK);
  1214. break;
  1215. default:
  1216. BUG();
  1217. return 0;
  1218. }
  1219. }
  1220. static unsigned int
  1221. video_poll(struct file *file, struct poll_table_struct *wait)
  1222. {
  1223. struct saa7134_fh *fh = file->private_data;
  1224. struct videobuf_buffer *buf = NULL;
  1225. if (V4L2_BUF_TYPE_VBI_CAPTURE == fh->type)
  1226. return videobuf_poll_stream(file, &fh->vbi, wait);
  1227. if (res_check(fh,RESOURCE_VIDEO)) {
  1228. if (!list_empty(&fh->cap.stream))
  1229. buf = list_entry(fh->cap.stream.next, struct videobuf_buffer, stream);
  1230. } else {
  1231. mutex_lock(&fh->cap.lock);
  1232. if (UNSET == fh->cap.read_off) {
  1233. /* need to capture a new frame */
  1234. if (res_locked(fh->dev,RESOURCE_VIDEO)) {
  1235. mutex_unlock(&fh->cap.lock);
  1236. return POLLERR;
  1237. }
  1238. if (0 != fh->cap.ops->buf_prepare(&fh->cap,fh->cap.read_buf,fh->cap.field)) {
  1239. mutex_unlock(&fh->cap.lock);
  1240. return POLLERR;
  1241. }
  1242. fh->cap.ops->buf_queue(&fh->cap,fh->cap.read_buf);
  1243. fh->cap.read_off = 0;
  1244. }
  1245. mutex_unlock(&fh->cap.lock);
  1246. buf = fh->cap.read_buf;
  1247. }
  1248. if (!buf)
  1249. return POLLERR;
  1250. poll_wait(file, &buf->done, wait);
  1251. if (buf->state == STATE_DONE ||
  1252. buf->state == STATE_ERROR)
  1253. return POLLIN|POLLRDNORM;
  1254. return 0;
  1255. }
  1256. static int video_release(struct inode *inode, struct file *file)
  1257. {
  1258. struct saa7134_fh *fh = file->private_data;
  1259. struct saa7134_dev *dev = fh->dev;
  1260. unsigned long flags;
  1261. /* turn off overlay */
  1262. if (res_check(fh, RESOURCE_OVERLAY)) {
  1263. spin_lock_irqsave(&dev->slock,flags);
  1264. stop_preview(dev,fh);
  1265. spin_unlock_irqrestore(&dev->slock,flags);
  1266. res_free(dev,fh,RESOURCE_OVERLAY);
  1267. }
  1268. /* stop video capture */
  1269. if (res_check(fh, RESOURCE_VIDEO)) {
  1270. videobuf_streamoff(&fh->cap);
  1271. res_free(dev,fh,RESOURCE_VIDEO);
  1272. }
  1273. if (fh->cap.read_buf) {
  1274. buffer_release(&fh->cap,fh->cap.read_buf);
  1275. kfree(fh->cap.read_buf);
  1276. }
  1277. /* stop vbi capture */
  1278. if (res_check(fh, RESOURCE_VBI)) {
  1279. if (fh->vbi.streaming)
  1280. videobuf_streamoff(&fh->vbi);
  1281. if (fh->vbi.reading)
  1282. videobuf_read_stop(&fh->vbi);
  1283. res_free(dev,fh,RESOURCE_VBI);
  1284. }
  1285. /* ts-capture will not work in planar mode, so turn it off Hac: 04.05*/
  1286. saa_andorb(SAA7134_OFMT_VIDEO_A, 0x1f, 0);
  1287. saa_andorb(SAA7134_OFMT_VIDEO_B, 0x1f, 0);
  1288. saa_andorb(SAA7134_OFMT_DATA_A, 0x1f, 0);
  1289. saa_andorb(SAA7134_OFMT_DATA_B, 0x1f, 0);
  1290. saa7134_i2c_call_clients(dev, TUNER_SET_STANDBY, NULL);
  1291. /* free stuff */
  1292. videobuf_mmap_free(&fh->cap);
  1293. videobuf_mmap_free(&fh->vbi);
  1294. saa7134_pgtable_free(dev->pci,&fh->pt_cap);
  1295. saa7134_pgtable_free(dev->pci,&fh->pt_vbi);
  1296. v4l2_prio_close(&dev->prio,&fh->prio);
  1297. file->private_data = NULL;
  1298. kfree(fh);
  1299. return 0;
  1300. }
  1301. static int
  1302. video_mmap(struct file *file, struct vm_area_struct * vma)
  1303. {
  1304. struct saa7134_fh *fh = file->private_data;
  1305. return videobuf_mmap_mapper(saa7134_queue(fh), vma);
  1306. }
  1307. /* ------------------------------------------------------------------ */
  1308. static void saa7134_vbi_fmt(struct saa7134_dev *dev, struct v4l2_format *f)
  1309. {
  1310. struct saa7134_tvnorm *norm = dev->tvnorm;
  1311. f->fmt.vbi.sampling_rate = 6750000 * 4;
  1312. f->fmt.vbi.samples_per_line = 2048 /* VBI_LINE_LENGTH */;
  1313. f->fmt.vbi.sample_format = V4L2_PIX_FMT_GREY;
  1314. f->fmt.vbi.offset = 64 * 4;
  1315. f->fmt.vbi.start[0] = norm->vbi_v_start_0;
  1316. f->fmt.vbi.count[0] = norm->vbi_v_stop_0 - norm->vbi_v_start_0 +1;
  1317. f->fmt.vbi.start[1] = norm->vbi_v_start_1;
  1318. f->fmt.vbi.count[1] = f->fmt.vbi.count[0];
  1319. f->fmt.vbi.flags = 0; /* VBI_UNSYNC VBI_INTERLACED */
  1320. }
  1321. static int saa7134_g_fmt(struct saa7134_dev *dev, struct saa7134_fh *fh,
  1322. struct v4l2_format *f)
  1323. {
  1324. switch (f->type) {
  1325. case V4L2_BUF_TYPE_VIDEO_CAPTURE:
  1326. memset(&f->fmt.pix,0,sizeof(f->fmt.pix));
  1327. f->fmt.pix.width = fh->width;
  1328. f->fmt.pix.height = fh->height;
  1329. f->fmt.pix.field = fh->cap.field;
  1330. f->fmt.pix.pixelformat = fh->fmt->fourcc;
  1331. f->fmt.pix.bytesperline =
  1332. (f->fmt.pix.width * fh->fmt->depth) >> 3;
  1333. f->fmt.pix.sizeimage =
  1334. f->fmt.pix.height * f->fmt.pix.bytesperline;
  1335. return 0;
  1336. case V4L2_BUF_TYPE_VIDEO_OVERLAY:
  1337. if (saa7134_no_overlay > 0) {
  1338. printk ("V4L2_BUF_TYPE_VIDEO_OVERLAY: no_overlay\n");
  1339. return -EINVAL;
  1340. }
  1341. f->fmt.win = fh->win;
  1342. return 0;
  1343. case V4L2_BUF_TYPE_VBI_CAPTURE:
  1344. saa7134_vbi_fmt(dev,f);
  1345. return 0;
  1346. default:
  1347. return -EINVAL;
  1348. }
  1349. }
  1350. static int saa7134_try_fmt(struct saa7134_dev *dev, struct saa7134_fh *fh,
  1351. struct v4l2_format *f)
  1352. {
  1353. int err;
  1354. switch (f->type) {
  1355. case V4L2_BUF_TYPE_VIDEO_CAPTURE:
  1356. {
  1357. struct saa7134_format *fmt;
  1358. enum v4l2_field field;
  1359. unsigned int maxw, maxh;
  1360. fmt = format_by_fourcc(f->fmt.pix.pixelformat);
  1361. if (NULL == fmt)
  1362. return -EINVAL;
  1363. field = f->fmt.pix.field;
  1364. maxw = min(dev->crop_current.width*4, dev->crop_bounds.width);
  1365. maxh = min(dev->crop_current.height*4, dev->crop_bounds.height);
  1366. if (V4L2_FIELD_ANY == field) {
  1367. field = (f->fmt.pix.height > maxh/2)
  1368. ? V4L2_FIELD_INTERLACED
  1369. : V4L2_FIELD_BOTTOM;
  1370. }
  1371. switch (field) {
  1372. case V4L2_FIELD_TOP:
  1373. case V4L2_FIELD_BOTTOM:
  1374. maxh = maxh / 2;
  1375. break;
  1376. case V4L2_FIELD_INTERLACED:
  1377. break;
  1378. default:
  1379. return -EINVAL;
  1380. }
  1381. f->fmt.pix.field = field;
  1382. if (f->fmt.pix.width < 48)
  1383. f->fmt.pix.width = 48;
  1384. if (f->fmt.pix.height < 32)
  1385. f->fmt.pix.height = 32;
  1386. if (f->fmt.pix.width > maxw)
  1387. f->fmt.pix.width = maxw;
  1388. if (f->fmt.pix.height > maxh)
  1389. f->fmt.pix.height = maxh;
  1390. f->fmt.pix.width &= ~0x03;
  1391. f->fmt.pix.bytesperline =
  1392. (f->fmt.pix.width * fmt->depth) >> 3;
  1393. f->fmt.pix.sizeimage =
  1394. f->fmt.pix.height * f->fmt.pix.bytesperline;
  1395. return 0;
  1396. }
  1397. case V4L2_BUF_TYPE_VIDEO_OVERLAY:
  1398. if (saa7134_no_overlay > 0) {
  1399. printk ("V4L2_BUF_TYPE_VIDEO_OVERLAY: no_overlay\n");
  1400. return -EINVAL;
  1401. }
  1402. err = verify_preview(dev,&f->fmt.win);
  1403. if (0 != err)
  1404. return err;
  1405. return 0;
  1406. case V4L2_BUF_TYPE_VBI_CAPTURE:
  1407. saa7134_vbi_fmt(dev,f);
  1408. return 0;
  1409. default:
  1410. return -EINVAL;
  1411. }
  1412. }
  1413. static int saa7134_s_fmt(struct saa7134_dev *dev, struct saa7134_fh *fh,
  1414. struct v4l2_format *f)
  1415. {
  1416. unsigned long flags;
  1417. int err;
  1418. switch (f->type) {
  1419. case V4L2_BUF_TYPE_VIDEO_CAPTURE:
  1420. err = saa7134_try_fmt(dev,fh,f);
  1421. if (0 != err)
  1422. return err;
  1423. fh->fmt = format_by_fourcc(f->fmt.pix.pixelformat);
  1424. fh->width = f->fmt.pix.width;
  1425. fh->height = f->fmt.pix.height;
  1426. fh->cap.field = f->fmt.pix.field;
  1427. return 0;
  1428. case V4L2_BUF_TYPE_VIDEO_OVERLAY:
  1429. if (saa7134_no_overlay > 0) {
  1430. printk ("V4L2_BUF_TYPE_VIDEO_OVERLAY: no_overlay\n");
  1431. return -EINVAL;
  1432. }
  1433. err = verify_preview(dev,&f->fmt.win);
  1434. if (0 != err)
  1435. return err;
  1436. mutex_lock(&dev->lock);
  1437. fh->win = f->fmt.win;
  1438. fh->nclips = f->fmt.win.clipcount;
  1439. if (fh->nclips > 8)
  1440. fh->nclips = 8;
  1441. if (copy_from_user(fh->clips,f->fmt.win.clips,
  1442. sizeof(struct v4l2_clip)*fh->nclips)) {
  1443. mutex_unlock(&dev->lock);
  1444. return -EFAULT;
  1445. }
  1446. if (res_check(fh, RESOURCE_OVERLAY)) {
  1447. spin_lock_irqsave(&dev->slock,flags);
  1448. stop_preview(dev,fh);
  1449. start_preview(dev,fh);
  1450. spin_unlock_irqrestore(&dev->slock,flags);
  1451. }
  1452. mutex_unlock(&dev->lock);
  1453. return 0;
  1454. case V4L2_BUF_TYPE_VBI_CAPTURE:
  1455. saa7134_vbi_fmt(dev,f);
  1456. return 0;
  1457. default:
  1458. return -EINVAL;
  1459. }
  1460. }
  1461. int saa7134_common_ioctl(struct saa7134_dev *dev,
  1462. unsigned int cmd, void *arg)
  1463. {
  1464. int err;
  1465. switch (cmd) {
  1466. case VIDIOC_QUERYCTRL:
  1467. {
  1468. const struct v4l2_queryctrl *ctrl;
  1469. struct v4l2_queryctrl *c = arg;
  1470. if ((c->id < V4L2_CID_BASE ||
  1471. c->id >= V4L2_CID_LASTP1) &&
  1472. (c->id < V4L2_CID_PRIVATE_BASE ||
  1473. c->id >= V4L2_CID_PRIVATE_LASTP1))
  1474. return -EINVAL;
  1475. ctrl = ctrl_by_id(c->id);
  1476. *c = (NULL != ctrl) ? *ctrl : no_ctrl;
  1477. return 0;
  1478. }
  1479. case VIDIOC_G_CTRL:
  1480. return get_control(dev,arg);
  1481. case VIDIOC_S_CTRL:
  1482. {
  1483. mutex_lock(&dev->lock);
  1484. err = set_control(dev,NULL,arg);
  1485. mutex_unlock(&dev->lock);
  1486. return err;
  1487. }
  1488. /* --- input switching --------------------------------------- */
  1489. case VIDIOC_ENUMINPUT:
  1490. {
  1491. struct v4l2_input *i = arg;
  1492. unsigned int n;
  1493. n = i->index;
  1494. if (n >= SAA7134_INPUT_MAX)
  1495. return -EINVAL;
  1496. if (NULL == card_in(dev,i->index).name)
  1497. return -EINVAL;
  1498. memset(i,0,sizeof(*i));
  1499. i->index = n;
  1500. i->type = V4L2_INPUT_TYPE_CAMERA;
  1501. strcpy(i->name,card_in(dev,n).name);
  1502. if (card_in(dev,n).tv)
  1503. i->type = V4L2_INPUT_TYPE_TUNER;
  1504. i->audioset = 1;
  1505. if (n == dev->ctl_input) {
  1506. int v1 = saa_readb(SAA7134_STATUS_VIDEO1);
  1507. int v2 = saa_readb(SAA7134_STATUS_VIDEO2);
  1508. if (0 != (v1 & 0x40))
  1509. i->status |= V4L2_IN_ST_NO_H_LOCK;
  1510. if (0 != (v2 & 0x40))
  1511. i->status |= V4L2_IN_ST_NO_SYNC;
  1512. if (0 != (v2 & 0x0e))
  1513. i->status |= V4L2_IN_ST_MACROVISION;
  1514. }
  1515. for (n = 0; n < TVNORMS; n++)
  1516. i->std |= tvnorms[n].id;
  1517. return 0;
  1518. }
  1519. case VIDIOC_G_INPUT:
  1520. {
  1521. int *i = arg;
  1522. *i = dev->ctl_input;
  1523. return 0;
  1524. }
  1525. case VIDIOC_S_INPUT:
  1526. {
  1527. int *i = arg;
  1528. if (*i < 0 || *i >= SAA7134_INPUT_MAX)
  1529. return -EINVAL;
  1530. if (NULL == card_in(dev,*i).name)
  1531. return -EINVAL;
  1532. mutex_lock(&dev->lock);
  1533. video_mux(dev,*i);
  1534. mutex_unlock(&dev->lock);
  1535. return 0;
  1536. }
  1537. }
  1538. return 0;
  1539. }
  1540. EXPORT_SYMBOL(saa7134_common_ioctl);
  1541. /*
  1542. * This function is _not_ called directly, but from
  1543. * video_generic_ioctl (and maybe others). userspace
  1544. * copying is done already, arg is a kernel pointer.
  1545. */
  1546. static int video_do_ioctl(struct inode *inode, struct file *file,
  1547. unsigned int cmd, void *arg)
  1548. {
  1549. struct saa7134_fh *fh = file->private_data;
  1550. struct saa7134_dev *dev = fh->dev;
  1551. unsigned long flags;
  1552. int err;
  1553. if (video_debug > 1)
  1554. v4l_print_ioctl(dev->name,cmd);
  1555. switch (cmd) {
  1556. case VIDIOC_S_CTRL:
  1557. case VIDIOC_S_STD:
  1558. case VIDIOC_S_INPUT:
  1559. case VIDIOC_S_TUNER:
  1560. case VIDIOC_S_FREQUENCY:
  1561. err = v4l2_prio_check(&dev->prio,&fh->prio);
  1562. if (0 != err)
  1563. return err;
  1564. }
  1565. switch (cmd) {
  1566. case VIDIOC_QUERYCAP:
  1567. {
  1568. struct v4l2_capability *cap = arg;
  1569. unsigned int tuner_type = dev->tuner_type;
  1570. memset(cap,0,sizeof(*cap));
  1571. strcpy(cap->driver, "saa7134");
  1572. strlcpy(cap->card, saa7134_boards[dev->board].name,
  1573. sizeof(cap->card));
  1574. sprintf(cap->bus_info,"PCI:%s",pci_name(dev->pci));
  1575. cap->version = SAA7134_VERSION_CODE;
  1576. cap->capabilities =
  1577. V4L2_CAP_VIDEO_CAPTURE |
  1578. V4L2_CAP_VBI_CAPTURE |
  1579. V4L2_CAP_READWRITE |
  1580. V4L2_CAP_STREAMING |
  1581. V4L2_CAP_TUNER;
  1582. if (saa7134_no_overlay <= 0) {
  1583. cap->capabilities |= V4L2_CAP_VIDEO_OVERLAY;
  1584. }
  1585. if ((tuner_type == TUNER_ABSENT) || (tuner_type == UNSET))
  1586. cap->capabilities &= ~V4L2_CAP_TUNER;
  1587. return 0;
  1588. }
  1589. /* --- tv standards ------------------------------------------ */
  1590. case VIDIOC_ENUMSTD:
  1591. {
  1592. struct v4l2_standard *e = arg;
  1593. unsigned int i;
  1594. i = e->index;
  1595. if (i >= TVNORMS)
  1596. return -EINVAL;
  1597. err = v4l2_video_std_construct(e, tvnorms[e->index].id,
  1598. tvnorms[e->index].name);
  1599. e->index = i;
  1600. if (err < 0)
  1601. return err;
  1602. return 0;
  1603. }
  1604. case VIDIOC_G_STD:
  1605. {
  1606. v4l2_std_id *id = arg;
  1607. *id = dev->tvnorm->id;
  1608. return 0;
  1609. }
  1610. case VIDIOC_S_STD:
  1611. {
  1612. v4l2_std_id *id = arg;
  1613. unsigned int i;
  1614. v4l2_std_id fixup;
  1615. for (i = 0; i < TVNORMS; i++)
  1616. if (*id == tvnorms[i].id)
  1617. break;
  1618. if (i == TVNORMS)
  1619. for (i = 0; i < TVNORMS; i++)
  1620. if (*id & tvnorms[i].id)
  1621. break;
  1622. if (i == TVNORMS)
  1623. return -EINVAL;
  1624. if ((*id & V4L2_STD_SECAM) && (secam[0] != '-')) {
  1625. if (secam[0] == 'L' || secam[0] == 'l') {
  1626. if (secam[1] == 'C' || secam[1] == 'c')
  1627. fixup = V4L2_STD_SECAM_LC;
  1628. else
  1629. fixup = V4L2_STD_SECAM_L;
  1630. } else {
  1631. if (secam[0] == 'D' || secam[0] == 'd')
  1632. fixup = V4L2_STD_SECAM_DK;
  1633. else
  1634. fixup = V4L2_STD_SECAM;
  1635. }
  1636. for (i = 0; i < TVNORMS; i++)
  1637. if (fixup == tvnorms[i].id)
  1638. break;
  1639. }
  1640. mutex_lock(&dev->lock);
  1641. if (res_check(fh, RESOURCE_OVERLAY)) {
  1642. spin_lock_irqsave(&dev->slock,flags);
  1643. stop_preview(dev,fh);
  1644. set_tvnorm(dev,&tvnorms[i]);
  1645. start_preview(dev,fh);
  1646. spin_unlock_irqrestore(&dev->slock,flags);
  1647. } else
  1648. set_tvnorm(dev,&tvnorms[i]);
  1649. saa7134_tvaudio_do_scan(dev);
  1650. mutex_unlock(&dev->lock);
  1651. return 0;
  1652. }
  1653. case VIDIOC_CROPCAP:
  1654. {
  1655. struct v4l2_cropcap *cap = arg;
  1656. if (cap->type != V4L2_BUF_TYPE_VIDEO_CAPTURE &&
  1657. cap->type != V4L2_BUF_TYPE_VIDEO_OVERLAY)
  1658. return -EINVAL;
  1659. cap->bounds = dev->crop_bounds;
  1660. cap->defrect = dev->crop_defrect;
  1661. cap->pixelaspect.numerator = 1;
  1662. cap->pixelaspect.denominator = 1;
  1663. if (dev->tvnorm->id & V4L2_STD_525_60) {
  1664. cap->pixelaspect.numerator = 11;
  1665. cap->pixelaspect.denominator = 10;
  1666. }
  1667. if (dev->tvnorm->id & V4L2_STD_625_50) {
  1668. cap->pixelaspect.numerator = 54;
  1669. cap->pixelaspect.denominator = 59;
  1670. }
  1671. return 0;
  1672. }
  1673. case VIDIOC_G_CROP:
  1674. {
  1675. struct v4l2_crop * crop = arg;
  1676. if (crop->type != V4L2_BUF_TYPE_VIDEO_CAPTURE &&
  1677. crop->type != V4L2_BUF_TYPE_VIDEO_OVERLAY)
  1678. return -EINVAL;
  1679. crop->c = dev->crop_current;
  1680. return 0;
  1681. }
  1682. case VIDIOC_S_CROP:
  1683. {
  1684. struct v4l2_crop *crop = arg;
  1685. struct v4l2_rect *b = &dev->crop_bounds;
  1686. if (crop->type != V4L2_BUF_TYPE_VIDEO_CAPTURE &&
  1687. crop->type != V4L2_BUF_TYPE_VIDEO_OVERLAY)
  1688. return -EINVAL;
  1689. if (crop->c.height < 0)
  1690. return -EINVAL;
  1691. if (crop->c.width < 0)
  1692. return -EINVAL;
  1693. if (res_locked(fh->dev,RESOURCE_OVERLAY))
  1694. return -EBUSY;
  1695. if (res_locked(fh->dev,RESOURCE_VIDEO))
  1696. return -EBUSY;
  1697. if (crop->c.top < b->top)
  1698. crop->c.top = b->top;
  1699. if (crop->c.top > b->top + b->height)
  1700. crop->c.top = b->top + b->height;
  1701. if (crop->c.height > b->top - crop->c.top + b->height)
  1702. crop->c.height = b->top - crop->c.top + b->height;
  1703. if (crop->c.left < b->left)
  1704. crop->c.left = b->left;
  1705. if (crop->c.left > b->left + b->width)
  1706. crop->c.left = b->left + b->width;
  1707. if (crop->c.width > b->left - crop->c.left + b->width)
  1708. crop->c.width = b->left - crop->c.left + b->width;
  1709. dev->crop_current = crop->c;
  1710. return 0;
  1711. }
  1712. /* --- tuner ioctls ------------------------------------------ */
  1713. case VIDIOC_G_TUNER:
  1714. {
  1715. struct v4l2_tuner *t = arg;
  1716. int n;
  1717. if (0 != t->index)
  1718. return -EINVAL;
  1719. memset(t,0,sizeof(*t));
  1720. for (n = 0; n < SAA7134_INPUT_MAX; n++)
  1721. if (card_in(dev,n).tv)
  1722. break;
  1723. if (NULL != card_in(dev,n).name) {
  1724. strcpy(t->name, "Television");
  1725. t->type = V4L2_TUNER_ANALOG_TV;
  1726. t->capability = V4L2_TUNER_CAP_NORM |
  1727. V4L2_TUNER_CAP_STEREO |
  1728. V4L2_TUNER_CAP_LANG1 |
  1729. V4L2_TUNER_CAP_LANG2;
  1730. t->rangehigh = 0xffffffffUL;
  1731. t->rxsubchans = saa7134_tvaudio_getstereo(dev);
  1732. t->audmode = saa7134_tvaudio_rx2mode(t->rxsubchans);
  1733. }
  1734. if (0 != (saa_readb(SAA7134_STATUS_VIDEO1) & 0x03))
  1735. t->signal = 0xffff;
  1736. return 0;
  1737. }
  1738. case VIDIOC_S_TUNER:
  1739. {
  1740. struct v4l2_tuner *t = arg;
  1741. int rx,mode;
  1742. mode = dev->thread.mode;
  1743. if (UNSET == mode) {
  1744. rx = saa7134_tvaudio_getstereo(dev);
  1745. mode = saa7134_tvaudio_rx2mode(t->rxsubchans);
  1746. }
  1747. if (mode != t->audmode) {
  1748. dev->thread.mode = t->audmode;
  1749. }
  1750. return 0;
  1751. }
  1752. case VIDIOC_G_FREQUENCY:
  1753. {
  1754. struct v4l2_frequency *f = arg;
  1755. memset(f,0,sizeof(*f));
  1756. f->type = fh->radio ? V4L2_TUNER_RADIO : V4L2_TUNER_ANALOG_TV;
  1757. f->frequency = dev->ctl_freq;
  1758. return 0;
  1759. }
  1760. case VIDIOC_S_FREQUENCY:
  1761. {
  1762. struct v4l2_frequency *f = arg;
  1763. if (0 != f->tuner)
  1764. return -EINVAL;
  1765. if (0 == fh->radio && V4L2_TUNER_ANALOG_TV != f->type)
  1766. return -EINVAL;
  1767. if (1 == fh->radio && V4L2_TUNER_RADIO != f->type)
  1768. return -EINVAL;
  1769. mutex_lock(&dev->lock);
  1770. dev->ctl_freq = f->frequency;
  1771. saa7134_i2c_call_clients(dev,VIDIOC_S_FREQUENCY,f);
  1772. saa7134_tvaudio_do_scan(dev);
  1773. mutex_unlock(&dev->lock);
  1774. return 0;
  1775. }
  1776. /* --- control ioctls ---------------------------------------- */
  1777. case VIDIOC_ENUMINPUT:
  1778. case VIDIOC_G_INPUT:
  1779. case VIDIOC_S_INPUT:
  1780. case VIDIOC_QUERYCTRL:
  1781. case VIDIOC_G_CTRL:
  1782. case VIDIOC_S_CTRL:
  1783. return saa7134_common_ioctl(dev, cmd, arg);
  1784. case VIDIOC_G_AUDIO:
  1785. {
  1786. struct v4l2_audio *a = arg;
  1787. memset(a,0,sizeof(*a));
  1788. strcpy(a->name,"audio");
  1789. return 0;
  1790. }
  1791. case VIDIOC_S_AUDIO:
  1792. return 0;
  1793. case VIDIOC_G_PARM:
  1794. {
  1795. struct v4l2_captureparm *parm = arg;
  1796. memset(parm,0,sizeof(*parm));
  1797. return 0;
  1798. }
  1799. case VIDIOC_G_PRIORITY:
  1800. {
  1801. enum v4l2_priority *p = arg;
  1802. *p = v4l2_prio_max(&dev->prio);
  1803. return 0;
  1804. }
  1805. case VIDIOC_S_PRIORITY:
  1806. {
  1807. enum v4l2_priority *prio = arg;
  1808. return v4l2_prio_change(&dev->prio, &fh->prio, *prio);
  1809. }
  1810. /* --- preview ioctls ---------------------------------------- */
  1811. case VIDIOC_ENUM_FMT:
  1812. {
  1813. struct v4l2_fmtdesc *f = arg;
  1814. enum v4l2_buf_type type;
  1815. unsigned int index;
  1816. index = f->index;
  1817. type = f->type;
  1818. switch (type) {
  1819. case V4L2_BUF_TYPE_VIDEO_CAPTURE:
  1820. case V4L2_BUF_TYPE_VIDEO_OVERLAY:
  1821. if (saa7134_no_overlay > 0) {
  1822. printk ("V4L2_BUF_TYPE_VIDEO_OVERLAY: no_overlay\n");
  1823. return -EINVAL;
  1824. }
  1825. if (index >= FORMATS)
  1826. return -EINVAL;
  1827. if (f->type == V4L2_BUF_TYPE_VIDEO_OVERLAY &&
  1828. formats[index].planar)
  1829. return -EINVAL;
  1830. memset(f,0,sizeof(*f));
  1831. f->index = index;
  1832. f->type = type;
  1833. strlcpy(f->description,formats[index].name,sizeof(f->description));
  1834. f->pixelformat = formats[index].fourcc;
  1835. break;
  1836. case V4L2_BUF_TYPE_VBI_CAPTURE:
  1837. if (0 != index)
  1838. return -EINVAL;
  1839. memset(f,0,sizeof(*f));
  1840. f->index = index;
  1841. f->type = type;
  1842. f->pixelformat = V4L2_PIX_FMT_GREY;
  1843. strcpy(f->description,"vbi data");
  1844. break;
  1845. default:
  1846. return -EINVAL;
  1847. }
  1848. return 0;
  1849. }
  1850. case VIDIOC_G_FBUF:
  1851. {
  1852. struct v4l2_framebuffer *fb = arg;
  1853. *fb = dev->ovbuf;
  1854. fb->capability = V4L2_FBUF_CAP_LIST_CLIPPING;
  1855. return 0;
  1856. }
  1857. case VIDIOC_S_FBUF:
  1858. {
  1859. struct v4l2_framebuffer *fb = arg;
  1860. struct saa7134_format *fmt;
  1861. if(!capable(CAP_SYS_ADMIN) &&
  1862. !capable(CAP_SYS_RAWIO))
  1863. return -EPERM;
  1864. /* check args */
  1865. fmt = format_by_fourcc(fb->fmt.pixelformat);
  1866. if (NULL == fmt)
  1867. return -EINVAL;
  1868. /* ok, accept it */
  1869. dev->ovbuf = *fb;
  1870. dev->ovfmt = fmt;
  1871. if (0 == dev->ovbuf.fmt.bytesperline)
  1872. dev->ovbuf.fmt.bytesperline =
  1873. dev->ovbuf.fmt.width*fmt->depth/8;
  1874. return 0;
  1875. }
  1876. case VIDIOC_OVERLAY:
  1877. {
  1878. int *on = arg;
  1879. if (*on) {
  1880. if (saa7134_no_overlay > 0) {
  1881. printk ("no_overlay\n");
  1882. return -EINVAL;
  1883. }
  1884. if (!res_get(dev,fh,RESOURCE_OVERLAY))
  1885. return -EBUSY;
  1886. spin_lock_irqsave(&dev->slock,flags);
  1887. start_preview(dev,fh);
  1888. spin_unlock_irqrestore(&dev->slock,flags);
  1889. }
  1890. if (!*on) {
  1891. if (!res_check(fh, RESOURCE_OVERLAY))
  1892. return -EINVAL;
  1893. spin_lock_irqsave(&dev->slock,flags);
  1894. stop_preview(dev,fh);
  1895. spin_unlock_irqrestore(&dev->slock,flags);
  1896. res_free(dev,fh,RESOURCE_OVERLAY);
  1897. }
  1898. return 0;
  1899. }
  1900. /* --- capture ioctls ---------------------------------------- */
  1901. case VIDIOC_G_FMT:
  1902. {
  1903. struct v4l2_format *f = arg;
  1904. return saa7134_g_fmt(dev,fh,f);
  1905. }
  1906. case VIDIOC_S_FMT:
  1907. {
  1908. struct v4l2_format *f = arg;
  1909. return saa7134_s_fmt(dev,fh,f);
  1910. }
  1911. case VIDIOC_TRY_FMT:
  1912. {
  1913. struct v4l2_format *f = arg;
  1914. return saa7134_try_fmt(dev,fh,f);
  1915. }
  1916. #ifdef CONFIG_VIDEO_V4L1_COMPAT
  1917. case VIDIOCGMBUF:
  1918. {
  1919. struct video_mbuf *mbuf = arg;
  1920. struct videobuf_queue *q;
  1921. struct v4l2_requestbuffers req;
  1922. unsigned int i;
  1923. q = saa7134_queue(fh);
  1924. memset(&req,0,sizeof(req));
  1925. req.type = q->type;
  1926. req.count = gbuffers;
  1927. req.memory = V4L2_MEMORY_MMAP;
  1928. err = videobuf_reqbufs(q,&req);
  1929. if (err < 0)
  1930. return err;
  1931. memset(mbuf,0,sizeof(*mbuf));
  1932. mbuf->frames = req.count;
  1933. mbuf->size = 0;
  1934. for (i = 0; i < mbuf->frames; i++) {
  1935. mbuf->offsets[i] = q->bufs[i]->boff;
  1936. mbuf->size += q->bufs[i]->bsize;
  1937. }
  1938. return 0;
  1939. }
  1940. #endif
  1941. case VIDIOC_REQBUFS:
  1942. return videobuf_reqbufs(saa7134_queue(fh),arg);
  1943. case VIDIOC_QUERYBUF:
  1944. return videobuf_querybuf(saa7134_queue(fh),arg);
  1945. case VIDIOC_QBUF:
  1946. return videobuf_qbuf(saa7134_queue(fh),arg);
  1947. case VIDIOC_DQBUF:
  1948. return videobuf_dqbuf(saa7134_queue(fh),arg,
  1949. file->f_flags & O_NONBLOCK);
  1950. case VIDIOC_STREAMON:
  1951. {
  1952. int res = saa7134_resource(fh);
  1953. if (!res_get(dev,fh,res))
  1954. return -EBUSY;
  1955. return videobuf_streamon(saa7134_queue(fh));
  1956. }
  1957. case VIDIOC_STREAMOFF:
  1958. {
  1959. int res = saa7134_resource(fh);
  1960. err = videobuf_streamoff(saa7134_queue(fh));
  1961. if (err < 0)
  1962. return err;
  1963. res_free(dev,fh,res);
  1964. return 0;
  1965. }
  1966. default:
  1967. return v4l_compat_translate_ioctl(inode,file,cmd,arg,
  1968. video_do_ioctl);
  1969. }
  1970. return 0;
  1971. }
  1972. static int video_ioctl(struct inode *inode, struct file *file,
  1973. unsigned int cmd, unsigned long arg)
  1974. {
  1975. return video_usercopy(inode, file, cmd, arg, video_do_ioctl);
  1976. }
  1977. static int radio_do_ioctl(struct inode *inode, struct file *file,
  1978. unsigned int cmd, void *arg)
  1979. {
  1980. struct saa7134_fh *fh = file->private_data;
  1981. struct saa7134_dev *dev = fh->dev;
  1982. if (video_debug > 1)
  1983. v4l_print_ioctl(dev->name,cmd);
  1984. switch (cmd) {
  1985. case VIDIOC_QUERYCAP:
  1986. {
  1987. struct v4l2_capability *cap = arg;
  1988. memset(cap,0,sizeof(*cap));
  1989. strcpy(cap->driver, "saa7134");
  1990. strlcpy(cap->card, saa7134_boards[dev->board].name,
  1991. sizeof(cap->card));
  1992. sprintf(cap->bus_info,"PCI:%s",pci_name(dev->pci));
  1993. cap->version = SAA7134_VERSION_CODE;
  1994. cap->capabilities = V4L2_CAP_TUNER;
  1995. return 0;
  1996. }
  1997. case VIDIOC_G_TUNER:
  1998. {
  1999. struct v4l2_tuner *t = arg;
  2000. if (0 != t->index)
  2001. return -EINVAL;
  2002. memset(t,0,sizeof(*t));
  2003. strcpy(t->name, "Radio");
  2004. t->type = V4L2_TUNER_RADIO;
  2005. saa7134_i2c_call_clients(dev, VIDIOC_G_TUNER, t);
  2006. if (dev->input->amux == TV) {
  2007. t->signal = 0xf800 - ((saa_readb(0x581) & 0x1f) << 11);
  2008. t->rxsubchans = (saa_readb(0x529) & 0x08) ?
  2009. V4L2_TUNER_SUB_STEREO : V4L2_TUNER_SUB_MONO;
  2010. }
  2011. return 0;
  2012. }
  2013. case VIDIOC_S_TUNER:
  2014. {
  2015. struct v4l2_tuner *t = arg;
  2016. if (0 != t->index)
  2017. return -EINVAL;
  2018. saa7134_i2c_call_clients(dev,VIDIOC_S_TUNER,t);
  2019. return 0;
  2020. }
  2021. case VIDIOC_ENUMINPUT:
  2022. {
  2023. struct v4l2_input *i = arg;
  2024. if (i->index != 0)
  2025. return -EINVAL;
  2026. strcpy(i->name,"Radio");
  2027. i->type = V4L2_INPUT_TYPE_TUNER;
  2028. return 0;
  2029. }
  2030. case VIDIOC_G_INPUT:
  2031. {
  2032. int *i = arg;
  2033. *i = 0;
  2034. return 0;
  2035. }
  2036. case VIDIOC_G_AUDIO:
  2037. {
  2038. struct v4l2_audio *a = arg;
  2039. memset(a,0,sizeof(*a));
  2040. strcpy(a->name,"Radio");
  2041. return 0;
  2042. }
  2043. case VIDIOC_G_STD:
  2044. {
  2045. v4l2_std_id *id = arg;
  2046. *id = 0;
  2047. return 0;
  2048. }
  2049. case VIDIOC_S_AUDIO:
  2050. case VIDIOC_S_INPUT:
  2051. case VIDIOC_S_STD:
  2052. return 0;
  2053. case VIDIOC_QUERYCTRL:
  2054. {
  2055. const struct v4l2_queryctrl *ctrl;
  2056. struct v4l2_queryctrl *c = arg;
  2057. if (c->id < V4L2_CID_BASE ||
  2058. c->id >= V4L2_CID_LASTP1)
  2059. return -EINVAL;
  2060. if (c->id == V4L2_CID_AUDIO_MUTE) {
  2061. ctrl = ctrl_by_id(c->id);
  2062. *c = *ctrl;
  2063. } else
  2064. *c = no_ctrl;
  2065. return 0;
  2066. }
  2067. case VIDIOC_G_CTRL:
  2068. case VIDIOC_S_CTRL:
  2069. case VIDIOC_G_FREQUENCY:
  2070. case VIDIOC_S_FREQUENCY:
  2071. return video_do_ioctl(inode,file,cmd,arg);
  2072. default:
  2073. return v4l_compat_translate_ioctl(inode,file,cmd,arg,
  2074. radio_do_ioctl);
  2075. }
  2076. return 0;
  2077. }
  2078. static int radio_ioctl(struct inode *inode, struct file *file,
  2079. unsigned int cmd, unsigned long arg)
  2080. {
  2081. return video_usercopy(inode, file, cmd, arg, radio_do_ioctl);
  2082. }
  2083. static struct file_operations video_fops =
  2084. {
  2085. .owner = THIS_MODULE,
  2086. .open = video_open,
  2087. .release = video_release,
  2088. .read = video_read,
  2089. .poll = video_poll,
  2090. .mmap = video_mmap,
  2091. .ioctl = video_ioctl,
  2092. .compat_ioctl = v4l_compat_ioctl32,
  2093. .llseek = no_llseek,
  2094. };
  2095. static struct file_operations radio_fops =
  2096. {
  2097. .owner = THIS_MODULE,
  2098. .open = video_open,
  2099. .release = video_release,
  2100. .ioctl = radio_ioctl,
  2101. .compat_ioctl = v4l_compat_ioctl32,
  2102. .llseek = no_llseek,
  2103. };
  2104. /* ----------------------------------------------------------- */
  2105. /* exported stuff */
  2106. struct video_device saa7134_video_template =
  2107. {
  2108. .name = "saa7134-video",
  2109. .type = VID_TYPE_CAPTURE|VID_TYPE_TUNER|
  2110. VID_TYPE_CLIPPING|VID_TYPE_SCALES,
  2111. .hardware = 0,
  2112. .fops = &video_fops,
  2113. .minor = -1,
  2114. };
  2115. struct video_device saa7134_vbi_template =
  2116. {
  2117. .name = "saa7134-vbi",
  2118. .type = VID_TYPE_TUNER|VID_TYPE_TELETEXT,
  2119. .hardware = 0,
  2120. .fops = &video_fops,
  2121. .minor = -1,
  2122. };
  2123. struct video_device saa7134_radio_template =
  2124. {
  2125. .name = "saa7134-radio",
  2126. .type = VID_TYPE_TUNER,
  2127. .hardware = 0,
  2128. .fops = &radio_fops,
  2129. .minor = -1,
  2130. };
  2131. int saa7134_video_init1(struct saa7134_dev *dev)
  2132. {
  2133. /* sanitycheck insmod options */
  2134. if (gbuffers < 2 || gbuffers > VIDEO_MAX_FRAME)
  2135. gbuffers = 2;
  2136. if (gbufsize < 0 || gbufsize > gbufsize_max)
  2137. gbufsize = gbufsize_max;
  2138. gbufsize = (gbufsize + PAGE_SIZE - 1) & PAGE_MASK;
  2139. /* put some sensible defaults into the data structures ... */
  2140. dev->ctl_bright = ctrl_by_id(V4L2_CID_BRIGHTNESS)->default_value;
  2141. dev->ctl_contrast = ctrl_by_id(V4L2_CID_CONTRAST)->default_value;
  2142. dev->ctl_hue = ctrl_by_id(V4L2_CID_HUE)->default_value;
  2143. dev->ctl_saturation = ctrl_by_id(V4L2_CID_SATURATION)->default_value;
  2144. dev->ctl_volume = ctrl_by_id(V4L2_CID_AUDIO_VOLUME)->default_value;
  2145. dev->ctl_mute = 1; // ctrl_by_id(V4L2_CID_AUDIO_MUTE)->default_value;
  2146. dev->ctl_invert = ctrl_by_id(V4L2_CID_PRIVATE_INVERT)->default_value;
  2147. dev->ctl_automute = ctrl_by_id(V4L2_CID_PRIVATE_AUTOMUTE)->default_value;
  2148. if (dev->tda9887_conf && dev->ctl_automute)
  2149. dev->tda9887_conf |= TDA9887_AUTOMUTE;
  2150. dev->automute = 0;
  2151. INIT_LIST_HEAD(&dev->video_q.queue);
  2152. init_timer(&dev->video_q.timeout);
  2153. dev->video_q.timeout.function = saa7134_buffer_timeout;
  2154. dev->video_q.timeout.data = (unsigned long)(&dev->video_q);
  2155. dev->video_q.dev = dev;
  2156. if (saa7134_boards[dev->board].video_out) {
  2157. /* enable video output */
  2158. int vo = saa7134_boards[dev->board].video_out;
  2159. int video_reg;
  2160. unsigned int vid_port_opts = saa7134_boards[dev->board].vid_port_opts;
  2161. saa_writeb(SAA7134_VIDEO_PORT_CTRL0, video_out[vo][0]);
  2162. video_reg = video_out[vo][1];
  2163. if (vid_port_opts & SET_T_CODE_POLARITY_NON_INVERTED)
  2164. video_reg &= ~VP_T_CODE_P_INVERTED;
  2165. saa_writeb(SAA7134_VIDEO_PORT_CTRL1, video_reg);
  2166. saa_writeb(SAA7134_VIDEO_PORT_CTRL2, video_out[vo][2]);
  2167. saa_writeb(SAA7134_VIDEO_PORT_CTRL3, video_out[vo][3]);
  2168. saa_writeb(SAA7134_VIDEO_PORT_CTRL4, video_out[vo][4]);
  2169. video_reg = video_out[vo][5];
  2170. if (vid_port_opts & SET_CLOCK_NOT_DELAYED)
  2171. video_reg &= ~VP_CLK_CTRL2_DELAYED;
  2172. if (vid_port_opts & SET_CLOCK_INVERTED)
  2173. video_reg |= VP_CLK_CTRL1_INVERTED;
  2174. saa_writeb(SAA7134_VIDEO_PORT_CTRL5, video_reg);
  2175. video_reg = video_out[vo][6];
  2176. if (vid_port_opts & SET_VSYNC_OFF) {
  2177. video_reg &= ~VP_VS_TYPE_MASK;
  2178. video_reg |= VP_VS_TYPE_OFF;
  2179. }
  2180. saa_writeb(SAA7134_VIDEO_PORT_CTRL6, video_reg);
  2181. saa_writeb(SAA7134_VIDEO_PORT_CTRL7, video_out[vo][7]);
  2182. saa_writeb(SAA7134_VIDEO_PORT_CTRL8, video_out[vo][8]);
  2183. }
  2184. return 0;
  2185. }
  2186. int saa7134_video_init2(struct saa7134_dev *dev)
  2187. {
  2188. /* init video hw */
  2189. set_tvnorm(dev,&tvnorms[0]);
  2190. video_mux(dev,0);
  2191. saa7134_tvaudio_setmute(dev);
  2192. saa7134_tvaudio_setvolume(dev,dev->ctl_volume);
  2193. return 0;
  2194. }
  2195. int saa7134_video_fini(struct saa7134_dev *dev)
  2196. {
  2197. /* nothing */
  2198. return 0;
  2199. }
  2200. void saa7134_irq_video_intl(struct saa7134_dev *dev)
  2201. {
  2202. static const char *st[] = {
  2203. "(no signal)", "NTSC", "PAL", "SECAM" };
  2204. u32 st1,st2;
  2205. st1 = saa_readb(SAA7134_STATUS_VIDEO1);
  2206. st2 = saa_readb(SAA7134_STATUS_VIDEO2);
  2207. dprintk("DCSDT: pll: %s, sync: %s, norm: %s\n",
  2208. (st1 & 0x40) ? "not locked" : "locked",
  2209. (st2 & 0x40) ? "no" : "yes",
  2210. st[st1 & 0x03]);
  2211. dev->nosignal = (st1 & 0x40) || (st2 & 0x40);
  2212. if (dev->nosignal) {
  2213. /* no video signal -> mute audio */
  2214. if (dev->ctl_automute)
  2215. dev->automute = 1;
  2216. saa7134_tvaudio_setmute(dev);
  2217. saa_setb(SAA7134_SYNC_CTRL, 0x20);
  2218. } else {
  2219. /* wake up tvaudio audio carrier scan thread */
  2220. saa7134_tvaudio_do_scan(dev);
  2221. if (!noninterlaced)
  2222. saa_clearb(SAA7134_SYNC_CTRL, 0x20);
  2223. }
  2224. if (dev->mops && dev->mops->signal_change)
  2225. dev->mops->signal_change(dev);
  2226. }
  2227. void saa7134_irq_video_done(struct saa7134_dev *dev, unsigned long status)
  2228. {
  2229. enum v4l2_field field;
  2230. spin_lock(&dev->slock);
  2231. if (dev->video_q.curr) {
  2232. dev->video_fieldcount++;
  2233. field = dev->video_q.curr->vb.field;
  2234. if (V4L2_FIELD_HAS_BOTH(field)) {
  2235. /* make sure we have seen both fields */
  2236. if ((status & 0x10) == 0x00) {
  2237. dev->video_q.curr->top_seen = 1;
  2238. goto done;
  2239. }
  2240. if (!dev->video_q.curr->top_seen)
  2241. goto done;
  2242. } else if (field == V4L2_FIELD_TOP) {
  2243. if ((status & 0x10) != 0x10)
  2244. goto done;
  2245. } else if (field == V4L2_FIELD_BOTTOM) {
  2246. if ((status & 0x10) != 0x00)
  2247. goto done;
  2248. }
  2249. dev->video_q.curr->vb.field_count = dev->video_fieldcount;
  2250. saa7134_buffer_finish(dev,&dev->video_q,STATE_DONE);
  2251. }
  2252. saa7134_buffer_next(dev,&dev->video_q);
  2253. done:
  2254. spin_unlock(&dev->slock);
  2255. }
  2256. /* ----------------------------------------------------------- */
  2257. /*
  2258. * Local variables:
  2259. * c-basic-offset: 8
  2260. * End:
  2261. */