usbvision-video.c 57 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045
  1. /*
  2. * USB USBVISION Video device driver 0.9.9
  3. *
  4. *
  5. *
  6. * Copyright (c) 1999-2005 Joerg Heckenbach <joerg@heckenbach-aw.de>
  7. *
  8. * This module is part of usbvision driver project.
  9. *
  10. * This program is free software; you can redistribute it and/or modify
  11. * it under the terms of the GNU General Public License as published by
  12. * the Free Software Foundation; either version 2 of the License, or
  13. * (at your option) any later version.
  14. *
  15. * This program is distributed in the hope that it will be useful,
  16. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  17. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  18. * GNU General Public License for more details.
  19. *
  20. * You should have received a copy of the GNU General Public License
  21. * along with this program; if not, write to the Free Software
  22. * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  23. *
  24. * Let's call the version 0.... until compression decoding is completely
  25. * implemented.
  26. *
  27. * This driver is written by Jose Ignacio Gijon and Joerg Heckenbach.
  28. * It was based on USB CPiA driver written by Peter Pregler,
  29. * Scott J. Bertin and Johannes Erdfelt
  30. * Ideas are taken from bttv driver by Ralph Metzler, Marcus Metzler &
  31. * Gerd Knorr and zoran 36120/36125 driver by Pauline Middelink
  32. * Updates to driver completed by Dwaine P. Garden
  33. *
  34. *
  35. * TODO:
  36. * - use submit_urb for all setup packets
  37. * - Fix memory settings for nt1004. It is 4 times as big as the
  38. * nt1003 memory.
  39. * - Add audio on endpoint 3 for nt1004 chip. Seems impossible, needs a codec interface. Which one?
  40. * - Clean up the driver.
  41. * - optimization for performance.
  42. * - Add Videotext capability (VBI). Working on it.....
  43. * - Check audio for other devices
  44. *
  45. */
  46. #include <linux/version.h>
  47. #include <linux/kernel.h>
  48. #include <linux/sched.h>
  49. #include <linux/list.h>
  50. #include <linux/timer.h>
  51. #include <linux/slab.h>
  52. #include <linux/mm.h>
  53. #include <linux/utsname.h>
  54. #include <linux/highmem.h>
  55. #include <linux/smp_lock.h>
  56. #include <linux/videodev.h>
  57. #include <linux/vmalloc.h>
  58. #include <linux/module.h>
  59. #include <linux/init.h>
  60. #include <linux/spinlock.h>
  61. #include <asm/io.h>
  62. #include <linux/videodev2.h>
  63. #include <linux/video_decoder.h>
  64. #include <linux/i2c.h>
  65. #include <media/saa7115.h>
  66. #include <media/v4l2-common.h>
  67. #include <media/tuner.h>
  68. #include <media/audiochip.h>
  69. #include <linux/moduleparam.h>
  70. #include <linux/workqueue.h>
  71. #ifdef CONFIG_KMOD
  72. #include <linux/kmod.h>
  73. #endif
  74. #include "usbvision.h"
  75. #define DRIVER_AUTHOR "Joerg Heckenbach <joerg@heckenbach-aw.de>, Dwaine Garden <DwaineGarden@rogers.com>"
  76. #define DRIVER_NAME "usbvision"
  77. #define DRIVER_ALIAS "USBVision"
  78. #define DRIVER_DESC "USBVision USB Video Device Driver for Linux"
  79. #define DRIVER_LICENSE "GPL"
  80. #define USBVISION_DRIVER_VERSION_MAJOR 0
  81. #define USBVISION_DRIVER_VERSION_MINOR 9
  82. #define USBVISION_DRIVER_VERSION_PATCHLEVEL 9
  83. #define USBVISION_DRIVER_VERSION KERNEL_VERSION(USBVISION_DRIVER_VERSION_MAJOR,USBVISION_DRIVER_VERSION_MINOR,USBVISION_DRIVER_VERSION_PATCHLEVEL)
  84. #define USBVISION_VERSION_STRING __stringify(USBVISION_DRIVER_VERSION_MAJOR) "." __stringify(USBVISION_DRIVER_VERSION_MINOR) "." __stringify(USBVISION_DRIVER_VERSION_PATCHLEVEL)
  85. #define ENABLE_HEXDUMP 0 /* Enable if you need it */
  86. #ifdef USBVISION_DEBUG
  87. #define PDEBUG(level, fmt, args...) \
  88. if (video_debug & (level)) info("[%s:%d] " fmt, __PRETTY_FUNCTION__, __LINE__ , ## args)
  89. #else
  90. #define PDEBUG(level, fmt, args...) do {} while(0)
  91. #endif
  92. #define DBG_IOCTL 1<<0
  93. #define DBG_IO 1<<1
  94. #define DBG_PROBE 1<<2
  95. #define DBG_MMAP 1<<3
  96. //String operations
  97. #define rmspace(str) while(*str==' ') str++;
  98. #define goto2next(str) while(*str!=' ') str++; while(*str==' ') str++;
  99. static int usbvision_nr = 0; // sequential number of usbvision device
  100. static struct usbvision_v4l2_format_st usbvision_v4l2_format[] = {
  101. { 1, 1, 8, V4L2_PIX_FMT_GREY , "GREY" },
  102. { 1, 2, 16, V4L2_PIX_FMT_RGB565 , "RGB565" },
  103. { 1, 3, 24, V4L2_PIX_FMT_RGB24 , "RGB24" },
  104. { 1, 4, 32, V4L2_PIX_FMT_RGB32 , "RGB32" },
  105. { 1, 2, 16, V4L2_PIX_FMT_RGB555 , "RGB555" },
  106. { 1, 2, 16, V4L2_PIX_FMT_YUYV , "YUV422" },
  107. { 1, 2, 12, V4L2_PIX_FMT_YVU420 , "YUV420P" }, // 1.5 !
  108. { 1, 2, 16, V4L2_PIX_FMT_YUV422P , "YUV422P" }
  109. };
  110. /* supported tv norms */
  111. static struct usbvision_tvnorm tvnorms[] = {
  112. {
  113. .name = "PAL",
  114. .id = V4L2_STD_PAL,
  115. }, {
  116. .name = "NTSC",
  117. .id = V4L2_STD_NTSC,
  118. }, {
  119. .name = "SECAM",
  120. .id = V4L2_STD_SECAM,
  121. }, {
  122. .name = "PAL-M",
  123. .id = V4L2_STD_PAL_M,
  124. }
  125. };
  126. #define TVNORMS ARRAY_SIZE(tvnorms)
  127. // Function prototypes
  128. static void usbvision_release(struct usb_usbvision *usbvision);
  129. // Default initalization of device driver parameters
  130. static int isocMode = ISOC_MODE_COMPRESS; // Set the default format for ISOC endpoint
  131. static int video_debug = 0; // Set the default Debug Mode of the device driver
  132. static int PowerOnAtOpen = 1; // Set the default device to power on at startup
  133. static int video_nr = -1; // Sequential Number of Video Device
  134. static int radio_nr = -1; // Sequential Number of Radio Device
  135. static int vbi_nr = -1; // Sequential Number of VBI Device
  136. static char *CustomDevice=NULL; // Set as nothing....
  137. // Grab parameters for the device driver
  138. #if defined(module_param) // Showing parameters under SYSFS
  139. module_param(isocMode, int, 0444);
  140. module_param(video_debug, int, 0444);
  141. module_param(PowerOnAtOpen, int, 0444);
  142. module_param(video_nr, int, 0444);
  143. module_param(radio_nr, int, 0444);
  144. module_param(vbi_nr, int, 0444);
  145. module_param(CustomDevice, charp, 0444);
  146. #else // Old Style
  147. MODULE_PARAM(isocMode, "i");
  148. MODULE_PARM(video_debug, "i"); // Grab the Debug Mode of the device driver
  149. MODULE_PARM(adjustCompression, "i"); // Grab the compression to be adaptive
  150. MODULE_PARM(PowerOnAtOpen, "i"); // Grab the device to power on at startup
  151. MODULE_PARM(SwitchSVideoInput, "i"); // To help people with Black and White output with using s-video input. Some cables and input device are wired differently.
  152. MODULE_PARM(video_nr, "i"); // video_nr option allows to specify a certain /dev/videoX device (like /dev/video0 or /dev/video1 ...)
  153. MODULE_PARM(radio_nr, "i"); // radio_nr option allows to specify a certain /dev/radioX device (like /dev/radio0 or /dev/radio1 ...)
  154. MODULE_PARM(vbi_nr, "i"); // vbi_nr option allows to specify a certain /dev/vbiX device (like /dev/vbi0 or /dev/vbi1 ...)
  155. MODULE_PARM(CustomDevice, "s"); // .... CustomDevice
  156. #endif
  157. MODULE_PARM_DESC(isocMode, " Set the default format for ISOC endpoint. Default: 0x60 (Compression On)");
  158. MODULE_PARM_DESC(video_debug, " Set the default Debug Mode of the device driver. Default: 0 (Off)");
  159. MODULE_PARM_DESC(PowerOnAtOpen, " Set the default device to power on when device is opened. Default: 1 (On)");
  160. MODULE_PARM_DESC(video_nr, "Set video device number (/dev/videoX). Default: -1 (autodetect)");
  161. MODULE_PARM_DESC(radio_nr, "Set radio device number (/dev/radioX). Default: -1 (autodetect)");
  162. MODULE_PARM_DESC(vbi_nr, "Set vbi device number (/dev/vbiX). Default: -1 (autodetect)");
  163. MODULE_PARM_DESC(CustomDevice, " Define the fine tuning parameters for the device. Default: null");
  164. // Misc stuff
  165. MODULE_AUTHOR(DRIVER_AUTHOR);
  166. MODULE_DESCRIPTION(DRIVER_DESC);
  167. MODULE_LICENSE(DRIVER_LICENSE);
  168. MODULE_VERSION(USBVISION_VERSION_STRING);
  169. MODULE_ALIAS(DRIVER_ALIAS);
  170. /****************************************************************************************/
  171. /* SYSFS Code - Copied from the stv680.c usb module. */
  172. /* Device information is located at /sys/class/video4linux/video0 */
  173. /* Device parameters information is located at /sys/module/usbvision */
  174. /* Device USB Information is located at /sys/bus/usb/drivers/USBVision Video Grabber */
  175. /****************************************************************************************/
  176. #define YES_NO(x) ((x) ? "Yes" : "No")
  177. static inline struct usb_usbvision *cd_to_usbvision(struct class_device *cd)
  178. {
  179. struct video_device *vdev = to_video_device(cd);
  180. return video_get_drvdata(vdev);
  181. }
  182. static ssize_t show_version(struct class_device *cd, char *buf)
  183. {
  184. return sprintf(buf, "%s\n", USBVISION_VERSION_STRING);
  185. }
  186. static CLASS_DEVICE_ATTR(version, S_IRUGO, show_version, NULL);
  187. static ssize_t show_model(struct class_device *class_dev, char *buf)
  188. {
  189. struct video_device *vdev = to_video_device(class_dev);
  190. struct usb_usbvision *usbvision = video_get_drvdata(vdev);
  191. return sprintf(buf, "%s\n", usbvision_device_data[usbvision->DevModel].ModelString);
  192. }
  193. static CLASS_DEVICE_ATTR(model, S_IRUGO, show_model, NULL);
  194. static ssize_t show_hue(struct class_device *class_dev, char *buf)
  195. {
  196. struct video_device *vdev = to_video_device(class_dev);
  197. struct usb_usbvision *usbvision = video_get_drvdata(vdev);
  198. struct v4l2_control ctrl;
  199. ctrl.id = V4L2_CID_HUE;
  200. ctrl.value = 0;
  201. call_i2c_clients(usbvision, VIDIOC_G_CTRL, &ctrl);
  202. return sprintf(buf, "%d\n", ctrl.value >> 8);
  203. }
  204. static CLASS_DEVICE_ATTR(hue, S_IRUGO, show_hue, NULL);
  205. static ssize_t show_contrast(struct class_device *class_dev, char *buf)
  206. {
  207. struct video_device *vdev = to_video_device(class_dev);
  208. struct usb_usbvision *usbvision = video_get_drvdata(vdev);
  209. struct v4l2_control ctrl;
  210. ctrl.id = V4L2_CID_CONTRAST;
  211. ctrl.value = 0;
  212. call_i2c_clients(usbvision, VIDIOC_G_CTRL, &ctrl);
  213. return sprintf(buf, "%d\n", ctrl.value >> 8);
  214. }
  215. static CLASS_DEVICE_ATTR(contrast, S_IRUGO, show_contrast, NULL);
  216. static ssize_t show_brightness(struct class_device *class_dev, char *buf)
  217. {
  218. struct video_device *vdev = to_video_device(class_dev);
  219. struct usb_usbvision *usbvision = video_get_drvdata(vdev);
  220. struct v4l2_control ctrl;
  221. ctrl.id = V4L2_CID_BRIGHTNESS;
  222. ctrl.value = 0;
  223. call_i2c_clients(usbvision, VIDIOC_G_CTRL, &ctrl);
  224. return sprintf(buf, "%d\n", ctrl.value >> 8);
  225. }
  226. static CLASS_DEVICE_ATTR(brightness, S_IRUGO, show_brightness, NULL);
  227. static ssize_t show_saturation(struct class_device *class_dev, char *buf)
  228. {
  229. struct video_device *vdev = to_video_device(class_dev);
  230. struct usb_usbvision *usbvision = video_get_drvdata(vdev);
  231. struct v4l2_control ctrl;
  232. ctrl.id = V4L2_CID_SATURATION;
  233. ctrl.value = 0;
  234. call_i2c_clients(usbvision, VIDIOC_G_CTRL, &ctrl);
  235. return sprintf(buf, "%d\n", ctrl.value >> 8);
  236. }
  237. static CLASS_DEVICE_ATTR(saturation, S_IRUGO, show_saturation, NULL);
  238. static ssize_t show_streaming(struct class_device *class_dev, char *buf)
  239. {
  240. struct video_device *vdev = to_video_device(class_dev);
  241. struct usb_usbvision *usbvision = video_get_drvdata(vdev);
  242. return sprintf(buf, "%s\n", YES_NO(usbvision->streaming==Stream_On?1:0));
  243. }
  244. static CLASS_DEVICE_ATTR(streaming, S_IRUGO, show_streaming, NULL);
  245. static ssize_t show_compression(struct class_device *class_dev, char *buf)
  246. {
  247. struct video_device *vdev = to_video_device(class_dev);
  248. struct usb_usbvision *usbvision = video_get_drvdata(vdev);
  249. return sprintf(buf, "%s\n", YES_NO(usbvision->isocMode==ISOC_MODE_COMPRESS));
  250. }
  251. static CLASS_DEVICE_ATTR(compression, S_IRUGO, show_compression, NULL);
  252. static ssize_t show_device_bridge(struct class_device *class_dev, char *buf)
  253. {
  254. struct video_device *vdev = to_video_device(class_dev);
  255. struct usb_usbvision *usbvision = video_get_drvdata(vdev);
  256. return sprintf(buf, "%d\n", usbvision->bridgeType);
  257. }
  258. static CLASS_DEVICE_ATTR(bridge, S_IRUGO, show_device_bridge, NULL);
  259. static void usbvision_create_sysfs(struct video_device *vdev)
  260. {
  261. int res;
  262. if (vdev) {
  263. res=video_device_create_file(vdev, &class_device_attr_version);
  264. res=video_device_create_file(vdev, &class_device_attr_model);
  265. res=video_device_create_file(vdev, &class_device_attr_hue);
  266. res=video_device_create_file(vdev, &class_device_attr_contrast);
  267. res=video_device_create_file(vdev, &class_device_attr_brightness);
  268. res=video_device_create_file(vdev, &class_device_attr_saturation);
  269. res=video_device_create_file(vdev, &class_device_attr_streaming);
  270. res=video_device_create_file(vdev, &class_device_attr_compression);
  271. res=video_device_create_file(vdev, &class_device_attr_bridge);
  272. }
  273. }
  274. static void usbvision_remove_sysfs(struct video_device *vdev)
  275. {
  276. if (vdev) {
  277. video_device_remove_file(vdev, &class_device_attr_version);
  278. video_device_remove_file(vdev, &class_device_attr_model);
  279. video_device_remove_file(vdev, &class_device_attr_hue);
  280. video_device_remove_file(vdev, &class_device_attr_contrast);
  281. video_device_remove_file(vdev, &class_device_attr_brightness);
  282. video_device_remove_file(vdev, &class_device_attr_saturation);
  283. video_device_remove_file(vdev, &class_device_attr_streaming);
  284. video_device_remove_file(vdev, &class_device_attr_compression);
  285. video_device_remove_file(vdev, &class_device_attr_bridge);
  286. }
  287. }
  288. /*
  289. * usbvision_open()
  290. *
  291. * This is part of Video 4 Linux API. The driver can be opened by one
  292. * client only (checks internal counter 'usbvision->user'). The procedure
  293. * then allocates buffers needed for video processing.
  294. *
  295. */
  296. static int usbvision_v4l2_open(struct inode *inode, struct file *file)
  297. {
  298. struct video_device *dev = video_devdata(file);
  299. struct usb_usbvision *usbvision = (struct usb_usbvision *) video_get_drvdata(dev);
  300. int errCode = 0;
  301. PDEBUG(DBG_IO, "open");
  302. usbvision_reset_powerOffTimer(usbvision);
  303. if (usbvision->user)
  304. errCode = -EBUSY;
  305. else {
  306. /* Allocate memory for the frame buffers */
  307. errCode = usbvision_frames_alloc(usbvision);
  308. if(!errCode) {
  309. /* Allocate memory for the scratch ring buffer */
  310. errCode = usbvision_scratch_alloc(usbvision);
  311. if ((!errCode) && (isocMode==ISOC_MODE_COMPRESS)) {
  312. /* Allocate intermediate decompression buffers only if needed */
  313. errCode = usbvision_decompress_alloc(usbvision);
  314. }
  315. }
  316. if (errCode) {
  317. /* Deallocate all buffers if trouble */
  318. usbvision_frames_free(usbvision);
  319. usbvision_scratch_free(usbvision);
  320. usbvision_decompress_free(usbvision);
  321. }
  322. }
  323. /* If so far no errors then we shall start the camera */
  324. if (!errCode) {
  325. down(&usbvision->lock);
  326. if (usbvision->power == 0) {
  327. usbvision_power_on(usbvision);
  328. usbvision_init_i2c(usbvision);
  329. }
  330. /* Send init sequence only once, it's large! */
  331. if (!usbvision->initialized) {
  332. int setup_ok = 0;
  333. setup_ok = usbvision_setup(usbvision,isocMode);
  334. if (setup_ok)
  335. usbvision->initialized = 1;
  336. else
  337. errCode = -EBUSY;
  338. }
  339. if (!errCode) {
  340. usbvision_begin_streaming(usbvision);
  341. errCode = usbvision_init_isoc(usbvision);
  342. /* device needs to be initialized before isoc transfer */
  343. usbvision_muxsel(usbvision,0);
  344. usbvision->user++;
  345. }
  346. else {
  347. if (PowerOnAtOpen) {
  348. usbvision_i2c_usb_del_bus(&usbvision->i2c_adap);
  349. usbvision_power_off(usbvision);
  350. usbvision->initialized = 0;
  351. }
  352. }
  353. up(&usbvision->lock);
  354. }
  355. if (errCode) {
  356. }
  357. /* prepare queues */
  358. usbvision_empty_framequeues(usbvision);
  359. PDEBUG(DBG_IO, "success");
  360. return errCode;
  361. }
  362. /*
  363. * usbvision_v4l2_close()
  364. *
  365. * This is part of Video 4 Linux API. The procedure
  366. * stops streaming and deallocates all buffers that were earlier
  367. * allocated in usbvision_v4l2_open().
  368. *
  369. */
  370. static int usbvision_v4l2_close(struct inode *inode, struct file *file)
  371. {
  372. struct video_device *dev = video_devdata(file);
  373. struct usb_usbvision *usbvision = (struct usb_usbvision *) video_get_drvdata(dev);
  374. PDEBUG(DBG_IO, "close");
  375. down(&usbvision->lock);
  376. usbvision_audio_off(usbvision);
  377. usbvision_restart_isoc(usbvision);
  378. usbvision_stop_isoc(usbvision);
  379. usbvision_decompress_free(usbvision);
  380. usbvision_frames_free(usbvision);
  381. usbvision_scratch_free(usbvision);
  382. usbvision->user--;
  383. if (PowerOnAtOpen) {
  384. /* power off in a little while to avoid off/on every close/open short sequences */
  385. usbvision_set_powerOffTimer(usbvision);
  386. usbvision->initialized = 0;
  387. }
  388. up(&usbvision->lock);
  389. if (usbvision->remove_pending) {
  390. info("%s: Final disconnect", __FUNCTION__);
  391. usbvision_release(usbvision);
  392. }
  393. PDEBUG(DBG_IO, "success");
  394. return 0;
  395. }
  396. /*
  397. * usbvision_ioctl()
  398. *
  399. * This is part of Video 4 Linux API. The procedure handles ioctl() calls.
  400. *
  401. */
  402. static int usbvision_v4l2_do_ioctl(struct inode *inode, struct file *file,
  403. unsigned int cmd, void *arg)
  404. {
  405. struct video_device *dev = video_devdata(file);
  406. struct usb_usbvision *usbvision = (struct usb_usbvision *) video_get_drvdata(dev);
  407. if (!USBVISION_IS_OPERATIONAL(usbvision))
  408. return -EFAULT;
  409. switch (cmd) {
  410. #ifdef CONFIG_VIDEO_ADV_DEBUG
  411. /* ioctls to allow direct acces to the NT100x registers */
  412. case VIDIOC_INT_G_REGISTER:
  413. {
  414. struct v4l2_register *reg = arg;
  415. int errCode;
  416. if (reg->i2c_id != 0)
  417. return -EINVAL;
  418. /* NT100x has a 8-bit register space */
  419. errCode = usbvision_read_reg(usbvision, reg->reg&0xff);
  420. if (errCode < 0) {
  421. err("%s: VIDIOC_INT_G_REGISTER failed: error %d", __FUNCTION__, errCode);
  422. }
  423. else {
  424. reg->val=(unsigned char)errCode;
  425. PDEBUG(DBG_IOCTL, "VIDIOC_INT_G_REGISTER reg=0x%02X, value=0x%02X",
  426. (unsigned int)reg->reg, reg->val);
  427. errCode = 0; // No error
  428. }
  429. return errCode;
  430. }
  431. case VIDIOC_INT_S_REGISTER:
  432. {
  433. struct v4l2_register *reg = arg;
  434. int errCode;
  435. if (reg->i2c_id != 0)
  436. return -EINVAL;
  437. if (!capable(CAP_SYS_ADMIN))
  438. return -EPERM;
  439. errCode = usbvision_write_reg(usbvision, reg->reg&0xff, reg->val);
  440. if (errCode < 0) {
  441. err("%s: VIDIOC_INT_S_REGISTER failed: error %d", __FUNCTION__, errCode);
  442. }
  443. else {
  444. PDEBUG(DBG_IOCTL, "VIDIOC_INT_S_REGISTER reg=0x%02X, value=0x%02X",
  445. (unsigned int)reg->reg, reg->val);
  446. errCode = 0;
  447. }
  448. return 0;
  449. }
  450. #endif
  451. case VIDIOC_QUERYCAP:
  452. {
  453. struct v4l2_capability *vc=arg;
  454. memset(vc, 0, sizeof(*vc));
  455. strlcpy(vc->driver, "USBVision", sizeof(vc->driver));
  456. strlcpy(vc->card, usbvision_device_data[usbvision->DevModel].ModelString,
  457. sizeof(vc->card));
  458. strlcpy(vc->bus_info, usbvision->dev->dev.bus_id,
  459. sizeof(vc->bus_info));
  460. vc->version = USBVISION_DRIVER_VERSION;
  461. vc->capabilities = V4L2_CAP_VIDEO_CAPTURE |
  462. V4L2_CAP_AUDIO |
  463. V4L2_CAP_READWRITE |
  464. V4L2_CAP_STREAMING |
  465. (usbvision->have_tuner ? V4L2_CAP_TUNER : 0);
  466. PDEBUG(DBG_IOCTL, "VIDIOC_QUERYCAP");
  467. return 0;
  468. }
  469. case VIDIOC_ENUMINPUT:
  470. {
  471. struct v4l2_input *vi = arg;
  472. int chan;
  473. if ((vi->index >= usbvision->video_inputs) || (vi->index < 0) )
  474. return -EINVAL;
  475. if (usbvision->have_tuner) {
  476. chan = vi->index;
  477. }
  478. else {
  479. chan = vi->index + 1; //skip Television string
  480. }
  481. switch(chan) {
  482. case 0:
  483. if (usbvision_device_data[usbvision->DevModel].VideoChannels == 4) {
  484. strcpy(vi->name, "White Video Input");
  485. }
  486. else {
  487. strcpy(vi->name, "Television");
  488. vi->type = V4L2_INPUT_TYPE_TUNER;
  489. vi->audioset = 1;
  490. vi->tuner = chan;
  491. vi->std = V4L2_STD_PAL | V4L2_STD_NTSC | V4L2_STD_SECAM;
  492. }
  493. break;
  494. case 1:
  495. vi->type = V4L2_INPUT_TYPE_CAMERA;
  496. if (usbvision_device_data[usbvision->DevModel].VideoChannels == 4) {
  497. strcpy(vi->name, "Green Video Input");
  498. }
  499. else {
  500. strcpy(vi->name, "Composite Video Input");
  501. }
  502. vi->std = V4L2_STD_PAL;
  503. break;
  504. case 2:
  505. vi->type = V4L2_INPUT_TYPE_CAMERA;
  506. if (usbvision_device_data[usbvision->DevModel].VideoChannels == 4) {
  507. strcpy(vi->name, "Yellow Video Input");
  508. }
  509. else {
  510. strcpy(vi->name, "S-Video Input");
  511. }
  512. vi->std = V4L2_STD_PAL;
  513. break;
  514. case 3:
  515. vi->type = V4L2_INPUT_TYPE_CAMERA;
  516. strcpy(vi->name, "Red Video Input");
  517. vi->std = V4L2_STD_PAL;
  518. break;
  519. }
  520. PDEBUG(DBG_IOCTL, "VIDIOC_ENUMINPUT name=%s:%d tuners=%d type=%d norm=%x",
  521. vi->name, vi->index, vi->tuner,vi->type,(int)vi->std);
  522. return 0;
  523. }
  524. case VIDIOC_ENUMSTD:
  525. {
  526. struct v4l2_standard *e = arg;
  527. unsigned int i;
  528. int ret;
  529. i = e->index;
  530. if (i >= TVNORMS)
  531. return -EINVAL;
  532. ret = v4l2_video_std_construct(e, tvnorms[e->index].id,
  533. tvnorms[e->index].name);
  534. e->index = i;
  535. if (ret < 0)
  536. return ret;
  537. return 0;
  538. }
  539. case VIDIOC_G_INPUT:
  540. {
  541. int *input = arg;
  542. *input = usbvision->ctl_input;
  543. return 0;
  544. }
  545. case VIDIOC_S_INPUT:
  546. {
  547. int *input = arg;
  548. if ((*input >= usbvision->video_inputs) || (*input < 0) )
  549. return -EINVAL;
  550. usbvision->ctl_input = *input;
  551. down(&usbvision->lock);
  552. usbvision_muxsel(usbvision, usbvision->ctl_input);
  553. usbvision_set_input(usbvision);
  554. usbvision_set_output(usbvision, usbvision->curwidth, usbvision->curheight);
  555. up(&usbvision->lock);
  556. return 0;
  557. }
  558. case VIDIOC_G_STD:
  559. {
  560. v4l2_std_id *id = arg;
  561. *id = usbvision->tvnorm->id;
  562. PDEBUG(DBG_IOCTL, "VIDIOC_G_STD std_id=%s", usbvision->tvnorm->name);
  563. return 0;
  564. }
  565. case VIDIOC_S_STD:
  566. {
  567. v4l2_std_id *id = arg;
  568. unsigned int i;
  569. for (i = 0; i < TVNORMS; i++)
  570. if (*id == tvnorms[i].id)
  571. break;
  572. if (i == TVNORMS)
  573. for (i = 0; i < TVNORMS; i++)
  574. if (*id & tvnorms[i].id)
  575. break;
  576. if (i == TVNORMS)
  577. return -EINVAL;
  578. down(&usbvision->lock);
  579. usbvision->tvnorm = &tvnorms[i];
  580. call_i2c_clients(usbvision, VIDIOC_S_STD,
  581. &usbvision->tvnorm->id);
  582. up(&usbvision->lock);
  583. PDEBUG(DBG_IOCTL, "VIDIOC_S_STD std_id=%s", usbvision->tvnorm->name);
  584. return 0;
  585. }
  586. case VIDIOC_G_TUNER:
  587. {
  588. struct v4l2_tuner *vt = arg;
  589. if (!usbvision->have_tuner || vt->index) // Only tuner 0
  590. return -EINVAL;
  591. strcpy(vt->name, "Television");
  592. /* Let clients fill in the remainder of this struct */
  593. call_i2c_clients(usbvision,VIDIOC_G_TUNER,vt);
  594. PDEBUG(DBG_IOCTL, "VIDIOC_G_TUNER signal=%x, afc=%x",vt->signal,vt->afc);
  595. return 0;
  596. }
  597. case VIDIOC_S_TUNER:
  598. {
  599. struct v4l2_tuner *vt = arg;
  600. // Only no or one tuner for now
  601. if (!usbvision->have_tuner || vt->index)
  602. return -EINVAL;
  603. /* let clients handle this */
  604. call_i2c_clients(usbvision,VIDIOC_S_TUNER,vt);
  605. PDEBUG(DBG_IOCTL, "VIDIOC_S_TUNER");
  606. return 0;
  607. }
  608. case VIDIOC_G_FREQUENCY:
  609. {
  610. struct v4l2_frequency *freq = arg;
  611. freq->tuner = 0; // Only one tuner
  612. freq->type = V4L2_TUNER_ANALOG_TV;
  613. freq->frequency = usbvision->freq;
  614. PDEBUG(DBG_IOCTL, "VIDIOC_G_FREQUENCY freq=0x%X", (unsigned)freq->frequency);
  615. return 0;
  616. }
  617. case VIDIOC_S_FREQUENCY:
  618. {
  619. struct v4l2_frequency *freq = arg;
  620. // Only no or one tuner for now
  621. if (!usbvision->have_tuner || freq->tuner)
  622. return -EINVAL;
  623. usbvision->freq = freq->frequency;
  624. call_i2c_clients(usbvision, cmd, freq);
  625. PDEBUG(DBG_IOCTL, "VIDIOC_S_FREQUENCY freq=0x%X", (unsigned)freq->frequency);
  626. return 0;
  627. }
  628. case VIDIOC_G_AUDIO:
  629. {
  630. struct v4l2_audio *v = arg;
  631. memset(v,0, sizeof(v));
  632. strcpy(v->name, "TV");
  633. PDEBUG(DBG_IOCTL, "VIDIOC_G_AUDIO");
  634. return 0;
  635. }
  636. case VIDIOC_S_AUDIO:
  637. {
  638. struct v4l2_audio *v = arg;
  639. if(v->index) {
  640. return -EINVAL;
  641. }
  642. PDEBUG(DBG_IOCTL, "VIDIOC_S_AUDIO");
  643. return 0;
  644. }
  645. case VIDIOC_QUERYCTRL:
  646. {
  647. struct v4l2_queryctrl *ctrl = arg;
  648. int id=ctrl->id;
  649. memset(ctrl,0,sizeof(*ctrl));
  650. ctrl->id=id;
  651. call_i2c_clients(usbvision, cmd, arg);
  652. if (ctrl->type)
  653. return 0;
  654. else
  655. return -EINVAL;
  656. PDEBUG(DBG_IOCTL,"VIDIOC_QUERYCTRL id=%x value=%x",ctrl->id,ctrl->type);
  657. }
  658. case VIDIOC_G_CTRL:
  659. {
  660. struct v4l2_control *ctrl = arg;
  661. PDEBUG(DBG_IOCTL,"VIDIOC_G_CTRL id=%x value=%x",ctrl->id,ctrl->value);
  662. call_i2c_clients(usbvision, VIDIOC_G_CTRL, ctrl);
  663. return 0;
  664. }
  665. case VIDIOC_S_CTRL:
  666. {
  667. struct v4l2_control *ctrl = arg;
  668. PDEBUG(DBG_IOCTL, "VIDIOC_S_CTRL id=%x value=%x",ctrl->id,ctrl->value);
  669. call_i2c_clients(usbvision, VIDIOC_S_CTRL, ctrl);
  670. return 0;
  671. }
  672. case VIDIOC_REQBUFS:
  673. {
  674. struct v4l2_requestbuffers *vr = arg;
  675. int ret;
  676. RESTRICT_TO_RANGE(vr->count,1,USBVISION_NUMFRAMES);
  677. // Check input validity : the user must do a VIDEO CAPTURE and MMAP method.
  678. if((vr->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) ||
  679. (vr->memory != V4L2_MEMORY_MMAP))
  680. return -EINVAL;
  681. if(usbvision->streaming == Stream_On) {
  682. if ((ret = usbvision_stream_interrupt(usbvision)))
  683. return ret;
  684. }
  685. usbvision_empty_framequeues(usbvision);
  686. usbvision->curFrame = NULL;
  687. PDEBUG(DBG_IOCTL, "VIDIOC_REQBUFS count=%d",vr->count);
  688. return 0;
  689. }
  690. case VIDIOC_QUERYBUF:
  691. {
  692. struct v4l2_buffer *vb = arg;
  693. struct usbvision_frame *frame;
  694. // FIXME : must control that buffers are mapped (VIDIOC_REQBUFS has been called)
  695. if(vb->type != V4L2_CAP_VIDEO_CAPTURE) {
  696. return -EINVAL;
  697. }
  698. if(vb->index>=USBVISION_NUMFRAMES) {
  699. return -EINVAL;
  700. }
  701. // Updating the corresponding frame state
  702. vb->flags = 0;
  703. frame = &usbvision->frame[vb->index];
  704. if(frame->grabstate >= FrameState_Ready)
  705. vb->flags |= V4L2_BUF_FLAG_QUEUED;
  706. if(frame->grabstate >= FrameState_Done)
  707. vb->flags |= V4L2_BUF_FLAG_DONE;
  708. if(frame->grabstate == FrameState_Unused)
  709. vb->flags |= V4L2_BUF_FLAG_MAPPED;
  710. vb->memory = V4L2_MEMORY_MMAP;
  711. vb->m.offset = vb->index*usbvision->max_frame_size;
  712. vb->memory = V4L2_MEMORY_MMAP;
  713. vb->field = V4L2_FIELD_NONE;
  714. vb->length = usbvision->curwidth*usbvision->curheight*usbvision->palette.bytes_per_pixel;
  715. vb->timestamp = usbvision->frame[vb->index].timestamp;
  716. vb->sequence = usbvision->frame[vb->index].sequence;
  717. return 0;
  718. }
  719. case VIDIOC_QBUF:
  720. {
  721. struct v4l2_buffer *vb = arg;
  722. struct usbvision_frame *frame;
  723. unsigned long lock_flags;
  724. // FIXME : works only on VIDEO_CAPTURE MODE, MMAP.
  725. if(vb->type != V4L2_CAP_VIDEO_CAPTURE) {
  726. return -EINVAL;
  727. }
  728. if(vb->index>=USBVISION_NUMFRAMES) {
  729. return -EINVAL;
  730. }
  731. frame = &usbvision->frame[vb->index];
  732. if (frame->grabstate != FrameState_Unused) {
  733. return -EAGAIN;
  734. }
  735. /* Mark it as ready and enqueue frame */
  736. frame->grabstate = FrameState_Ready;
  737. frame->scanstate = ScanState_Scanning;
  738. frame->scanlength = 0; /* Accumulated in usbvision_parse_data() */
  739. vb->flags &= ~V4L2_BUF_FLAG_DONE;
  740. /* set v4l2_format index */
  741. frame->v4l2_format = usbvision->palette;
  742. spin_lock_irqsave(&usbvision->queue_lock, lock_flags);
  743. list_add_tail(&usbvision->frame[vb->index].frame, &usbvision->inqueue);
  744. spin_unlock_irqrestore(&usbvision->queue_lock, lock_flags);
  745. PDEBUG(DBG_IOCTL, "VIDIOC_QBUF frame #%d",vb->index);
  746. return 0;
  747. }
  748. case VIDIOC_DQBUF:
  749. {
  750. struct v4l2_buffer *vb = arg;
  751. int ret;
  752. struct usbvision_frame *f;
  753. unsigned long lock_flags;
  754. if (vb->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
  755. return -EINVAL;
  756. if (list_empty(&(usbvision->outqueue))) {
  757. if (usbvision->streaming == Stream_Idle)
  758. return -EINVAL;
  759. ret = wait_event_interruptible
  760. (usbvision->wait_frame,
  761. !list_empty(&(usbvision->outqueue)));
  762. if (ret)
  763. return ret;
  764. }
  765. spin_lock_irqsave(&usbvision->queue_lock, lock_flags);
  766. f = list_entry(usbvision->outqueue.next,
  767. struct usbvision_frame, frame);
  768. list_del(usbvision->outqueue.next);
  769. spin_unlock_irqrestore(&usbvision->queue_lock, lock_flags);
  770. f->grabstate = FrameState_Unused;
  771. vb->memory = V4L2_MEMORY_MMAP;
  772. vb->flags = V4L2_BUF_FLAG_MAPPED | V4L2_BUF_FLAG_QUEUED | V4L2_BUF_FLAG_DONE;
  773. vb->index = f->index;
  774. vb->sequence = f->sequence;
  775. vb->timestamp = f->timestamp;
  776. vb->field = V4L2_FIELD_NONE;
  777. vb->bytesused = f->scanlength;
  778. return 0;
  779. }
  780. case VIDIOC_STREAMON:
  781. {
  782. int b=V4L2_BUF_TYPE_VIDEO_CAPTURE;
  783. usbvision->streaming = Stream_On;
  784. call_i2c_clients(usbvision,VIDIOC_STREAMON , &b);
  785. PDEBUG(DBG_IOCTL, "VIDIOC_STREAMON");
  786. return 0;
  787. }
  788. case VIDIOC_STREAMOFF:
  789. {
  790. int *type = arg;
  791. int b=V4L2_BUF_TYPE_VIDEO_CAPTURE;
  792. if (*type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
  793. return -EINVAL;
  794. if(usbvision->streaming == Stream_On) {
  795. usbvision_stream_interrupt(usbvision);
  796. // Stop all video streamings
  797. call_i2c_clients(usbvision,VIDIOC_STREAMOFF , &b);
  798. }
  799. usbvision_empty_framequeues(usbvision);
  800. PDEBUG(DBG_IOCTL, "VIDIOC_STREAMOFF");
  801. return 0;
  802. }
  803. case VIDIOC_ENUM_FMT:
  804. {
  805. struct v4l2_fmtdesc *vfd = arg;
  806. if(vfd->index>=USBVISION_SUPPORTED_PALETTES-1) {
  807. return -EINVAL;
  808. }
  809. vfd->flags = 0;
  810. vfd->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
  811. strcpy(vfd->description,usbvision_v4l2_format[vfd->index].desc);
  812. vfd->pixelformat = usbvision_v4l2_format[vfd->index].format;
  813. memset(vfd->reserved, 0, sizeof(vfd->reserved));
  814. return 0;
  815. }
  816. case VIDIOC_G_FMT:
  817. {
  818. struct v4l2_format *vf = arg;
  819. switch (vf->type) {
  820. case V4L2_BUF_TYPE_VIDEO_CAPTURE:
  821. {
  822. vf->fmt.pix.width = usbvision->curwidth;
  823. vf->fmt.pix.height = usbvision->curheight;
  824. vf->fmt.pix.pixelformat = usbvision->palette.format;
  825. vf->fmt.pix.bytesperline = usbvision->curwidth*usbvision->palette.bytes_per_pixel;
  826. vf->fmt.pix.sizeimage = vf->fmt.pix.bytesperline*usbvision->curheight;
  827. vf->fmt.pix.colorspace = V4L2_COLORSPACE_SMPTE170M;
  828. vf->fmt.pix.field = V4L2_FIELD_NONE; /* Always progressive image */
  829. PDEBUG(DBG_IOCTL, "VIDIOC_G_FMT w=%d, h=%d, format=%s",
  830. vf->fmt.pix.width, vf->fmt.pix.height,usbvision->palette.desc);
  831. return 0;
  832. }
  833. default:
  834. PDEBUG(DBG_IOCTL, "VIDIOC_G_FMT invalid type %d",vf->type);
  835. return -EINVAL;
  836. }
  837. return 0;
  838. }
  839. case VIDIOC_TRY_FMT:
  840. case VIDIOC_S_FMT:
  841. {
  842. struct v4l2_format *vf = arg;
  843. int formatIdx,ret;
  844. switch(vf->type) {
  845. case V4L2_BUF_TYPE_VIDEO_CAPTURE:
  846. {
  847. /* Find requested format in available ones */
  848. for(formatIdx=0;formatIdx<USBVISION_SUPPORTED_PALETTES;formatIdx++) {
  849. if(vf->fmt.pix.pixelformat == usbvision_v4l2_format[formatIdx].format) {
  850. usbvision->palette = usbvision_v4l2_format[formatIdx];
  851. break;
  852. }
  853. }
  854. /* robustness */
  855. if(formatIdx == USBVISION_SUPPORTED_PALETTES) {
  856. return -EINVAL;
  857. }
  858. RESTRICT_TO_RANGE(vf->fmt.pix.width, MIN_FRAME_WIDTH, MAX_FRAME_WIDTH);
  859. RESTRICT_TO_RANGE(vf->fmt.pix.height, MIN_FRAME_HEIGHT, MAX_FRAME_HEIGHT);
  860. vf->fmt.pix.bytesperline = vf->fmt.pix.width*usbvision->palette.bytes_per_pixel;
  861. vf->fmt.pix.sizeimage = vf->fmt.pix.bytesperline*vf->fmt.pix.height;
  862. if(cmd == VIDIOC_TRY_FMT) {
  863. PDEBUG(DBG_IOCTL, "VIDIOC_TRY_FMT grabdisplay w=%d, h=%d, format=%s",
  864. vf->fmt.pix.width, vf->fmt.pix.height,usbvision->palette.desc);
  865. return 0;
  866. }
  867. /* stop io in case it is already in progress */
  868. if(usbvision->streaming == Stream_On) {
  869. if ((ret = usbvision_stream_interrupt(usbvision)))
  870. return ret;
  871. }
  872. usbvision_empty_framequeues(usbvision);
  873. usbvision->curFrame = NULL;
  874. // by now we are committed to the new data...
  875. down(&usbvision->lock);
  876. usbvision_set_output(usbvision, vf->fmt.pix.width, vf->fmt.pix.height);
  877. up(&usbvision->lock);
  878. PDEBUG(DBG_IOCTL, "VIDIOC_S_FMT grabdisplay w=%d, h=%d, format=%s",
  879. vf->fmt.pix.width, vf->fmt.pix.height,usbvision->palette.desc);
  880. return 0;
  881. }
  882. default:
  883. return -EINVAL;
  884. }
  885. }
  886. default:
  887. return -ENOIOCTLCMD;
  888. }
  889. return 0;
  890. }
  891. static int usbvision_v4l2_ioctl(struct inode *inode, struct file *file,
  892. unsigned int cmd, unsigned long arg)
  893. {
  894. return video_usercopy(inode, file, cmd, arg, usbvision_v4l2_do_ioctl);
  895. }
  896. static ssize_t usbvision_v4l2_read(struct file *file, char *buf,
  897. size_t count, loff_t *ppos)
  898. {
  899. struct video_device *dev = video_devdata(file);
  900. struct usb_usbvision *usbvision = (struct usb_usbvision *) video_get_drvdata(dev);
  901. int noblock = file->f_flags & O_NONBLOCK;
  902. unsigned long lock_flags;
  903. int frmx = -1;
  904. int ret,i;
  905. struct usbvision_frame *frame;
  906. PDEBUG(DBG_IO, "%s: %ld bytes, noblock=%d", __FUNCTION__, (unsigned long)count, noblock);
  907. if (!USBVISION_IS_OPERATIONAL(usbvision) || (buf == NULL))
  908. return -EFAULT;
  909. /* no stream is running, make it running ! */
  910. usbvision->streaming = Stream_On;
  911. call_i2c_clients(usbvision,VIDIOC_STREAMON , NULL);
  912. /* First, enqueue as many frames as possible (like a user of VIDIOC_QBUF would do) */
  913. for(i=0;i<USBVISION_NUMFRAMES;i++) {
  914. frame = &usbvision->frame[i];
  915. if(frame->grabstate == FrameState_Unused) {
  916. /* Mark it as ready and enqueue frame */
  917. frame->grabstate = FrameState_Ready;
  918. frame->scanstate = ScanState_Scanning;
  919. frame->scanlength = 0; /* Accumulated in usbvision_parse_data() */
  920. /* set v4l2_format index */
  921. frame->v4l2_format = usbvision->palette;
  922. spin_lock_irqsave(&usbvision->queue_lock, lock_flags);
  923. list_add_tail(&frame->frame, &usbvision->inqueue);
  924. spin_unlock_irqrestore(&usbvision->queue_lock, lock_flags);
  925. }
  926. }
  927. /* Then try to steal a frame (like a VIDIOC_DQBUF would do) */
  928. if (list_empty(&(usbvision->outqueue))) {
  929. if(noblock)
  930. return -EAGAIN;
  931. ret = wait_event_interruptible
  932. (usbvision->wait_frame,
  933. !list_empty(&(usbvision->outqueue)));
  934. if (ret)
  935. return ret;
  936. }
  937. spin_lock_irqsave(&usbvision->queue_lock, lock_flags);
  938. frame = list_entry(usbvision->outqueue.next,
  939. struct usbvision_frame, frame);
  940. list_del(usbvision->outqueue.next);
  941. spin_unlock_irqrestore(&usbvision->queue_lock, lock_flags);
  942. /* An error returns an empty frame */
  943. if (frame->grabstate == FrameState_Error) {
  944. frame->bytes_read = 0;
  945. return 0;
  946. }
  947. PDEBUG(DBG_IO, "%s: frmx=%d, bytes_read=%ld, scanlength=%ld", __FUNCTION__,
  948. frame->index, frame->bytes_read, frame->scanlength);
  949. /* copy bytes to user space; we allow for partials reads */
  950. if ((count + frame->bytes_read) > (unsigned long)frame->scanlength)
  951. count = frame->scanlength - frame->bytes_read;
  952. if (copy_to_user(buf, frame->data + frame->bytes_read, count)) {
  953. return -EFAULT;
  954. }
  955. frame->bytes_read += count;
  956. PDEBUG(DBG_IO, "%s: {copy} count used=%ld, new bytes_read=%ld", __FUNCTION__,
  957. (unsigned long)count, frame->bytes_read);
  958. // For now, forget the frame if it has not been read in one shot.
  959. /* if (frame->bytes_read >= frame->scanlength) {// All data has been read */
  960. frame->bytes_read = 0;
  961. /* Mark it as available to be used again. */
  962. usbvision->frame[frmx].grabstate = FrameState_Unused;
  963. /* } */
  964. return count;
  965. }
  966. static int usbvision_v4l2_mmap(struct file *file, struct vm_area_struct *vma)
  967. {
  968. unsigned long size = vma->vm_end - vma->vm_start,
  969. start = vma->vm_start;
  970. void *pos;
  971. u32 i;
  972. struct video_device *dev = video_devdata(file);
  973. struct usb_usbvision *usbvision = (struct usb_usbvision *) video_get_drvdata(dev);
  974. down(&usbvision->lock);
  975. if (!USBVISION_IS_OPERATIONAL(usbvision)) {
  976. up(&usbvision->lock);
  977. return -EFAULT;
  978. }
  979. if (!(vma->vm_flags & VM_WRITE) ||
  980. size != PAGE_ALIGN(usbvision->curwidth*usbvision->curheight*usbvision->palette.bytes_per_pixel)) {
  981. up(&usbvision->lock);
  982. return -EINVAL;
  983. }
  984. for (i = 0; i < USBVISION_NUMFRAMES; i++) {
  985. if (((usbvision->max_frame_size*i) >> PAGE_SHIFT) == vma->vm_pgoff)
  986. break;
  987. }
  988. if (i == USBVISION_NUMFRAMES) {
  989. PDEBUG(DBG_MMAP, "mmap: user supplied mapping address is out of range");
  990. up(&usbvision->lock);
  991. return -EINVAL;
  992. }
  993. /* VM_IO is eventually going to replace PageReserved altogether */
  994. vma->vm_flags |= VM_IO;
  995. vma->vm_flags |= VM_RESERVED; /* avoid to swap out this VMA */
  996. pos = usbvision->frame[i].data;
  997. while (size > 0) {
  998. if (vm_insert_page(vma, start, vmalloc_to_page(pos))) {
  999. PDEBUG(DBG_MMAP, "mmap: vm_insert_page failed");
  1000. up(&usbvision->lock);
  1001. return -EAGAIN;
  1002. }
  1003. start += PAGE_SIZE;
  1004. pos += PAGE_SIZE;
  1005. size -= PAGE_SIZE;
  1006. }
  1007. up(&usbvision->lock);
  1008. return 0;
  1009. }
  1010. /*
  1011. * Here comes the stuff for radio on usbvision based devices
  1012. *
  1013. */
  1014. static int usbvision_radio_open(struct inode *inode, struct file *file)
  1015. {
  1016. struct video_device *dev = video_devdata(file);
  1017. struct usb_usbvision *usbvision = (struct usb_usbvision *) video_get_drvdata(dev);
  1018. struct v4l2_frequency freq;
  1019. int errCode = 0;
  1020. PDEBUG(DBG_IO, "%s:", __FUNCTION__);
  1021. down(&usbvision->lock);
  1022. if (usbvision->user) {
  1023. err("%s: Someone tried to open an already opened USBVision Radio!", __FUNCTION__);
  1024. errCode = -EBUSY;
  1025. }
  1026. else {
  1027. if(PowerOnAtOpen) {
  1028. usbvision_reset_powerOffTimer(usbvision);
  1029. if (usbvision->power == 0) {
  1030. usbvision_power_on(usbvision);
  1031. usbvision_init_i2c(usbvision);
  1032. }
  1033. }
  1034. // If so far no errors then we shall start the radio
  1035. usbvision->radio = 1;
  1036. call_i2c_clients(usbvision,AUDC_SET_RADIO,&usbvision->tuner_type);
  1037. freq.frequency = 1517; //SWR3 @ 94.8MHz
  1038. call_i2c_clients(usbvision, VIDIOC_S_FREQUENCY, &freq);
  1039. usbvision_set_audio(usbvision, USBVISION_AUDIO_RADIO);
  1040. usbvision->user++;
  1041. }
  1042. if (errCode) {
  1043. if (PowerOnAtOpen) {
  1044. usbvision_i2c_usb_del_bus(&usbvision->i2c_adap);
  1045. usbvision_power_off(usbvision);
  1046. usbvision->initialized = 0;
  1047. }
  1048. }
  1049. up(&usbvision->lock);
  1050. return errCode;
  1051. }
  1052. static int usbvision_radio_close(struct inode *inode, struct file *file)
  1053. {
  1054. struct video_device *dev = video_devdata(file);
  1055. struct usb_usbvision *usbvision = (struct usb_usbvision *) video_get_drvdata(dev);
  1056. int errCode = 0;
  1057. PDEBUG(DBG_IO, "");
  1058. down(&usbvision->lock);
  1059. usbvision_audio_off(usbvision);
  1060. usbvision->radio=0;
  1061. usbvision->user--;
  1062. if (PowerOnAtOpen) {
  1063. usbvision_set_powerOffTimer(usbvision);
  1064. usbvision->initialized = 0;
  1065. }
  1066. up(&usbvision->lock);
  1067. if (usbvision->remove_pending) {
  1068. info("%s: Final disconnect", __FUNCTION__);
  1069. usbvision_release(usbvision);
  1070. }
  1071. PDEBUG(DBG_IO, "success");
  1072. return errCode;
  1073. }
  1074. static int usbvision_do_radio_ioctl(struct inode *inode, struct file *file,
  1075. unsigned int cmd, void *arg)
  1076. {
  1077. struct video_device *dev = video_devdata(file);
  1078. struct usb_usbvision *usbvision = (struct usb_usbvision *) video_get_drvdata(dev);
  1079. if (!USBVISION_IS_OPERATIONAL(usbvision))
  1080. return -EIO;
  1081. switch (cmd) {
  1082. case VIDIOC_QUERYCAP:
  1083. {
  1084. struct v4l2_capability *vc=arg;
  1085. memset(vc, 0, sizeof(*vc));
  1086. strlcpy(vc->driver, "USBVision", sizeof(vc->driver));
  1087. strlcpy(vc->card, usbvision_device_data[usbvision->DevModel].ModelString,
  1088. sizeof(vc->card));
  1089. strlcpy(vc->bus_info, usbvision->dev->dev.bus_id,
  1090. sizeof(vc->bus_info));
  1091. vc->version = USBVISION_DRIVER_VERSION;
  1092. vc->capabilities = (usbvision->have_tuner ? V4L2_CAP_TUNER : 0);
  1093. PDEBUG(DBG_IO, "VIDIOC_QUERYCAP");
  1094. return 0;
  1095. }
  1096. case VIDIOC_QUERYCTRL:
  1097. {
  1098. struct v4l2_queryctrl *ctrl = arg;
  1099. int id=ctrl->id;
  1100. memset(ctrl,0,sizeof(*ctrl));
  1101. ctrl->id=id;
  1102. call_i2c_clients(usbvision, cmd, arg);
  1103. PDEBUG(DBG_IO,"VIDIOC_QUERYCTRL id=%x value=%x",ctrl->id,ctrl->type);
  1104. if (ctrl->type)
  1105. return 0;
  1106. else
  1107. return -EINVAL;
  1108. }
  1109. case VIDIOC_G_CTRL:
  1110. {
  1111. struct v4l2_control *ctrl = arg;
  1112. call_i2c_clients(usbvision, VIDIOC_G_CTRL, ctrl);
  1113. PDEBUG(DBG_IO,"VIDIOC_G_CTRL id=%x value=%x",ctrl->id,ctrl->value);
  1114. return 0;
  1115. }
  1116. case VIDIOC_S_CTRL:
  1117. {
  1118. struct v4l2_control *ctrl = arg;
  1119. call_i2c_clients(usbvision, VIDIOC_S_CTRL, ctrl);
  1120. PDEBUG(DBG_IO, "VIDIOC_S_CTRL id=%x value=%x",ctrl->id,ctrl->value);
  1121. return 0;
  1122. }
  1123. case VIDIOC_G_TUNER:
  1124. {
  1125. struct v4l2_tuner *t = arg;
  1126. if (t->index > 0)
  1127. return -EINVAL;
  1128. memset(t,0,sizeof(*t));
  1129. strcpy(t->name, "Radio");
  1130. t->type = V4L2_TUNER_RADIO;
  1131. /* Let clients fill in the remainder of this struct */
  1132. call_i2c_clients(usbvision,VIDIOC_G_TUNER,t);
  1133. PDEBUG(DBG_IO, "VIDIOC_G_TUNER signal=%x, afc=%x",t->signal,t->afc);
  1134. return 0;
  1135. }
  1136. case VIDIOC_S_TUNER:
  1137. {
  1138. struct v4l2_tuner *vt = arg;
  1139. // Only no or one tuner for now
  1140. if (!usbvision->have_tuner || vt->index)
  1141. return -EINVAL;
  1142. /* let clients handle this */
  1143. call_i2c_clients(usbvision,VIDIOC_S_TUNER,vt);
  1144. PDEBUG(DBG_IO, "VIDIOC_S_TUNER");
  1145. return 0;
  1146. }
  1147. case VIDIOC_G_AUDIO:
  1148. {
  1149. struct v4l2_audio *a = arg;
  1150. memset(a,0,sizeof(*a));
  1151. strcpy(a->name,"Radio");
  1152. PDEBUG(DBG_IO, "VIDIOC_G_AUDIO");
  1153. return 0;
  1154. }
  1155. case VIDIOC_S_AUDIO:
  1156. case VIDIOC_S_INPUT:
  1157. case VIDIOC_S_STD:
  1158. return 0;
  1159. case VIDIOC_G_FREQUENCY:
  1160. {
  1161. struct v4l2_frequency *f = arg;
  1162. memset(f,0,sizeof(*f));
  1163. f->type = V4L2_TUNER_RADIO;
  1164. f->frequency = usbvision->freq;
  1165. call_i2c_clients(usbvision, cmd, f);
  1166. PDEBUG(DBG_IO, "VIDIOC_G_FREQUENCY freq=0x%X", (unsigned)f->frequency);
  1167. return 0;
  1168. }
  1169. case VIDIOC_S_FREQUENCY:
  1170. {
  1171. struct v4l2_frequency *f = arg;
  1172. if (f->tuner != 0)
  1173. return -EINVAL;
  1174. usbvision->freq = f->frequency;
  1175. call_i2c_clients(usbvision, cmd, f);
  1176. PDEBUG(DBG_IO, "VIDIOC_S_FREQUENCY freq=0x%X", (unsigned)f->frequency);
  1177. return 0;
  1178. }
  1179. default:
  1180. {
  1181. PDEBUG(DBG_IO, "%s: Unknown command %x", __FUNCTION__, cmd);
  1182. return -ENOIOCTLCMD;
  1183. }
  1184. }
  1185. return 0;
  1186. }
  1187. static int usbvision_radio_ioctl(struct inode *inode, struct file *file,
  1188. unsigned int cmd, unsigned long arg)
  1189. {
  1190. return video_usercopy(inode, file, cmd, arg, usbvision_do_radio_ioctl);
  1191. }
  1192. /*
  1193. * Here comes the stuff for vbi on usbvision based devices
  1194. *
  1195. */
  1196. static int usbvision_vbi_open(struct inode *inode, struct file *file)
  1197. {
  1198. /* TODO */
  1199. return -EINVAL;
  1200. }
  1201. static int usbvision_vbi_close(struct inode *inode, struct file *file)
  1202. {
  1203. /* TODO */
  1204. return -EINVAL;
  1205. }
  1206. static int usbvision_do_vbi_ioctl(struct inode *inode, struct file *file,
  1207. unsigned int cmd, void *arg)
  1208. {
  1209. /* TODO */
  1210. return -EINVAL;
  1211. }
  1212. static int usbvision_vbi_ioctl(struct inode *inode, struct file *file,
  1213. unsigned int cmd, unsigned long arg)
  1214. {
  1215. return video_usercopy(inode, file, cmd, arg, usbvision_do_vbi_ioctl);
  1216. }
  1217. //
  1218. // Video registration stuff
  1219. //
  1220. // Video template
  1221. static struct file_operations usbvision_fops = {
  1222. .owner = THIS_MODULE,
  1223. .open = usbvision_v4l2_open,
  1224. .release = usbvision_v4l2_close,
  1225. .read = usbvision_v4l2_read,
  1226. .mmap = usbvision_v4l2_mmap,
  1227. .ioctl = usbvision_v4l2_ioctl,
  1228. .llseek = no_llseek,
  1229. };
  1230. static struct video_device usbvision_video_template = {
  1231. .owner = THIS_MODULE,
  1232. .type = VID_TYPE_TUNER | VID_TYPE_CAPTURE,
  1233. .hardware = VID_HARDWARE_USBVISION,
  1234. .fops = &usbvision_fops,
  1235. .name = "usbvision-video",
  1236. .release = video_device_release,
  1237. .minor = -1,
  1238. };
  1239. // Radio template
  1240. static struct file_operations usbvision_radio_fops = {
  1241. .owner = THIS_MODULE,
  1242. .open = usbvision_radio_open,
  1243. .release = usbvision_radio_close,
  1244. .ioctl = usbvision_radio_ioctl,
  1245. .llseek = no_llseek,
  1246. };
  1247. static struct video_device usbvision_radio_template=
  1248. {
  1249. .owner = THIS_MODULE,
  1250. .type = VID_TYPE_TUNER,
  1251. .hardware = VID_HARDWARE_USBVISION,
  1252. .fops = &usbvision_radio_fops,
  1253. .release = video_device_release,
  1254. .name = "usbvision-radio",
  1255. .minor = -1,
  1256. };
  1257. // vbi template
  1258. static struct file_operations usbvision_vbi_fops = {
  1259. .owner = THIS_MODULE,
  1260. .open = usbvision_vbi_open,
  1261. .release = usbvision_vbi_close,
  1262. .ioctl = usbvision_vbi_ioctl,
  1263. .llseek = no_llseek,
  1264. };
  1265. static struct video_device usbvision_vbi_template=
  1266. {
  1267. .owner = THIS_MODULE,
  1268. .type = VID_TYPE_TUNER,
  1269. .hardware = VID_HARDWARE_USBVISION,
  1270. .fops = &usbvision_vbi_fops,
  1271. .release = video_device_release,
  1272. .name = "usbvision-vbi",
  1273. .minor = -1,
  1274. };
  1275. static struct video_device *usbvision_vdev_init(struct usb_usbvision *usbvision,
  1276. struct video_device *vdev_template,
  1277. char *name)
  1278. {
  1279. struct usb_device *usb_dev = usbvision->dev;
  1280. struct video_device *vdev;
  1281. if (usb_dev == NULL) {
  1282. err("%s: usbvision->dev is not set", __FUNCTION__);
  1283. return NULL;
  1284. }
  1285. vdev = video_device_alloc();
  1286. if (NULL == vdev) {
  1287. return NULL;
  1288. }
  1289. *vdev = *vdev_template;
  1290. // vdev->minor = -1;
  1291. vdev->dev = &usb_dev->dev;
  1292. snprintf(vdev->name, sizeof(vdev->name), "%s", name);
  1293. video_set_drvdata(vdev, usbvision);
  1294. return vdev;
  1295. }
  1296. // unregister video4linux devices
  1297. static void usbvision_unregister_video(struct usb_usbvision *usbvision)
  1298. {
  1299. // vbi Device:
  1300. if (usbvision->vbi) {
  1301. PDEBUG(DBG_PROBE, "unregister /dev/vbi%d [v4l2]", usbvision->vbi->minor & 0x1f);
  1302. if (usbvision->vbi->minor != -1) {
  1303. video_unregister_device(usbvision->vbi);
  1304. }
  1305. else {
  1306. video_device_release(usbvision->vbi);
  1307. }
  1308. usbvision->vbi = NULL;
  1309. }
  1310. // Radio Device:
  1311. if (usbvision->rdev) {
  1312. PDEBUG(DBG_PROBE, "unregister /dev/radio%d [v4l2]", usbvision->rdev->minor & 0x1f);
  1313. if (usbvision->rdev->minor != -1) {
  1314. video_unregister_device(usbvision->rdev);
  1315. }
  1316. else {
  1317. video_device_release(usbvision->rdev);
  1318. }
  1319. usbvision->rdev = NULL;
  1320. }
  1321. // Video Device:
  1322. if (usbvision->vdev) {
  1323. PDEBUG(DBG_PROBE, "unregister /dev/video%d [v4l2]", usbvision->vdev->minor & 0x1f);
  1324. if (usbvision->vdev->minor != -1) {
  1325. video_unregister_device(usbvision->vdev);
  1326. }
  1327. else {
  1328. video_device_release(usbvision->vdev);
  1329. }
  1330. usbvision->vdev = NULL;
  1331. }
  1332. }
  1333. // register video4linux devices
  1334. static int __devinit usbvision_register_video(struct usb_usbvision *usbvision)
  1335. {
  1336. // Video Device:
  1337. usbvision->vdev = usbvision_vdev_init(usbvision, &usbvision_video_template, "USBVision Video");
  1338. if (usbvision->vdev == NULL) {
  1339. goto err_exit;
  1340. }
  1341. if (video_register_device(usbvision->vdev, VFL_TYPE_GRABBER, video_nr)<0) {
  1342. goto err_exit;
  1343. }
  1344. info("USBVision[%d]: registered USBVision Video device /dev/video%d [v4l2]", usbvision->nr,usbvision->vdev->minor & 0x1f);
  1345. // Radio Device:
  1346. if (usbvision_device_data[usbvision->DevModel].Radio) {
  1347. // usbvision has radio
  1348. usbvision->rdev = usbvision_vdev_init(usbvision, &usbvision_radio_template, "USBVision Radio");
  1349. if (usbvision->rdev == NULL) {
  1350. goto err_exit;
  1351. }
  1352. if (video_register_device(usbvision->rdev, VFL_TYPE_RADIO, radio_nr)<0) {
  1353. goto err_exit;
  1354. }
  1355. info("USBVision[%d]: registered USBVision Radio device /dev/radio%d [v4l2]", usbvision->nr, usbvision->rdev->minor & 0x1f);
  1356. }
  1357. // vbi Device:
  1358. if (usbvision_device_data[usbvision->DevModel].vbi) {
  1359. usbvision->vbi = usbvision_vdev_init(usbvision, &usbvision_vbi_template, "USBVision VBI");
  1360. if (usbvision->vdev == NULL) {
  1361. goto err_exit;
  1362. }
  1363. if (video_register_device(usbvision->vbi, VFL_TYPE_VBI, vbi_nr)<0) {
  1364. goto err_exit;
  1365. }
  1366. info("USBVision[%d]: registered USBVision VBI device /dev/vbi%d [v4l2] (Not Working Yet!)", usbvision->nr,usbvision->vbi->minor & 0x1f);
  1367. }
  1368. // all done
  1369. return 0;
  1370. err_exit:
  1371. err("USBVision[%d]: video_register_device() failed", usbvision->nr);
  1372. usbvision_unregister_video(usbvision);
  1373. return -1;
  1374. }
  1375. /*
  1376. * usbvision_alloc()
  1377. *
  1378. * This code allocates the struct usb_usbvision. It is filled with default values.
  1379. *
  1380. * Returns NULL on error, a pointer to usb_usbvision else.
  1381. *
  1382. */
  1383. static struct usb_usbvision *usbvision_alloc(struct usb_device *dev)
  1384. {
  1385. struct usb_usbvision *usbvision;
  1386. if ((usbvision = kzalloc(sizeof(struct usb_usbvision), GFP_KERNEL)) == NULL) {
  1387. goto err_exit;
  1388. }
  1389. usbvision->dev = dev;
  1390. init_MUTEX(&usbvision->lock); /* to 1 == available */
  1391. // prepare control urb for control messages during interrupts
  1392. usbvision->ctrlUrb = usb_alloc_urb(USBVISION_URB_FRAMES, GFP_KERNEL);
  1393. if (usbvision->ctrlUrb == NULL) {
  1394. goto err_exit;
  1395. }
  1396. init_waitqueue_head(&usbvision->ctrlUrb_wq);
  1397. init_MUTEX(&usbvision->ctrlUrbLock); /* to 1 == available */
  1398. usbvision_init_powerOffTimer(usbvision);
  1399. return usbvision;
  1400. err_exit:
  1401. if (usbvision && usbvision->ctrlUrb) {
  1402. usb_free_urb(usbvision->ctrlUrb);
  1403. }
  1404. if (usbvision) {
  1405. kfree(usbvision);
  1406. }
  1407. return NULL;
  1408. }
  1409. /*
  1410. * usbvision_release()
  1411. *
  1412. * This code does final release of struct usb_usbvision. This happens
  1413. * after the device is disconnected -and- all clients closed their files.
  1414. *
  1415. */
  1416. static void usbvision_release(struct usb_usbvision *usbvision)
  1417. {
  1418. PDEBUG(DBG_PROBE, "");
  1419. down(&usbvision->lock);
  1420. usbvision_reset_powerOffTimer(usbvision);
  1421. usbvision->initialized = 0;
  1422. up(&usbvision->lock);
  1423. usbvision_remove_sysfs(usbvision->vdev);
  1424. usbvision_unregister_video(usbvision);
  1425. if (usbvision->ctrlUrb) {
  1426. usb_free_urb(usbvision->ctrlUrb);
  1427. }
  1428. kfree(usbvision);
  1429. PDEBUG(DBG_PROBE, "success");
  1430. }
  1431. /******************************** usb interface *****************************************/
  1432. static void usbvision_configure_video(struct usb_usbvision *usbvision)
  1433. {
  1434. int model,i;
  1435. if (usbvision == NULL)
  1436. return;
  1437. model = usbvision->DevModel;
  1438. usbvision->palette = usbvision_v4l2_format[2]; // V4L2_PIX_FMT_RGB24;
  1439. if (usbvision_device_data[usbvision->DevModel].Vin_Reg2 >= 0) {
  1440. usbvision->Vin_Reg2_Preset = usbvision_device_data[usbvision->DevModel].Vin_Reg2 & 0xff;
  1441. } else {
  1442. usbvision->Vin_Reg2_Preset = 0;
  1443. }
  1444. for (i = 0; i < TVNORMS; i++)
  1445. if (usbvision_device_data[model].VideoNorm == tvnorms[i].mode)
  1446. break;
  1447. if (i == TVNORMS)
  1448. i = 0;
  1449. usbvision->tvnorm = &tvnorms[i]; /* set default norm */
  1450. usbvision->video_inputs = usbvision_device_data[model].VideoChannels;
  1451. usbvision->ctl_input = 0;
  1452. /* This should be here to make i2c clients to be able to register */
  1453. usbvision_audio_off(usbvision); //first switch off audio
  1454. if (!PowerOnAtOpen) {
  1455. usbvision_power_on(usbvision); //and then power up the noisy tuner
  1456. usbvision_init_i2c(usbvision);
  1457. }
  1458. }
  1459. /*
  1460. * usbvision_probe()
  1461. *
  1462. * This procedure queries device descriptor and accepts the interface
  1463. * if it looks like USBVISION video device
  1464. *
  1465. */
  1466. static int __devinit usbvision_probe(struct usb_interface *intf, const struct usb_device_id *devid)
  1467. {
  1468. struct usb_device *dev = interface_to_usbdev(intf);
  1469. __u8 ifnum = intf->altsetting->desc.bInterfaceNumber;
  1470. const struct usb_host_interface *interface;
  1471. struct usb_usbvision *usbvision = NULL;
  1472. const struct usb_endpoint_descriptor *endpoint;
  1473. int model;
  1474. PDEBUG(DBG_PROBE, "VID=%#04x, PID=%#04x, ifnum=%u",
  1475. dev->descriptor.idVendor, dev->descriptor.idProduct, ifnum);
  1476. /* Is it an USBVISION video dev? */
  1477. model = 0;
  1478. for(model = 0; usbvision_device_data[model].idVendor; model++) {
  1479. if (le16_to_cpu(dev->descriptor.idVendor) != usbvision_device_data[model].idVendor) {
  1480. continue;
  1481. }
  1482. if (le16_to_cpu(dev->descriptor.idProduct) != usbvision_device_data[model].idProduct) {
  1483. continue;
  1484. }
  1485. info("%s: %s found", __FUNCTION__, usbvision_device_data[model].ModelString);
  1486. break;
  1487. }
  1488. if (usbvision_device_data[model].idVendor == 0) {
  1489. return -ENODEV; //no matching device
  1490. }
  1491. if (usbvision_device_data[model].Interface >= 0) {
  1492. interface = &dev->actconfig->interface[usbvision_device_data[model].Interface]->altsetting[0];
  1493. }
  1494. else {
  1495. interface = &dev->actconfig->interface[ifnum]->altsetting[0];
  1496. }
  1497. endpoint = &interface->endpoint[1].desc;
  1498. if ((endpoint->bmAttributes & USB_ENDPOINT_XFERTYPE_MASK) != USB_ENDPOINT_XFER_ISOC) {
  1499. err("%s: interface %d. has non-ISO endpoint!", __FUNCTION__, ifnum);
  1500. err("%s: Endpoint attribures %d", __FUNCTION__, endpoint->bmAttributes);
  1501. return -ENODEV;
  1502. }
  1503. if ((endpoint->bEndpointAddress & USB_ENDPOINT_DIR_MASK) == USB_DIR_OUT) {
  1504. err("%s: interface %d. has ISO OUT endpoint!", __FUNCTION__, ifnum);
  1505. return -ENODEV;
  1506. }
  1507. usb_get_dev(dev);
  1508. if ((usbvision = usbvision_alloc(dev)) == NULL) {
  1509. err("%s: couldn't allocate USBVision struct", __FUNCTION__);
  1510. return -ENOMEM;
  1511. }
  1512. if (dev->descriptor.bNumConfigurations > 1) {
  1513. usbvision->bridgeType = BRIDGE_NT1004;
  1514. }
  1515. else if (usbvision_device_data[model].ModelString == "Dazzle Fusion Model DVC-90 Rev 1 (SECAM)") {
  1516. usbvision->bridgeType = BRIDGE_NT1005;
  1517. }
  1518. else {
  1519. usbvision->bridgeType = BRIDGE_NT1003;
  1520. }
  1521. PDEBUG(DBG_PROBE, "bridgeType %d", usbvision->bridgeType);
  1522. down(&usbvision->lock);
  1523. usbvision->nr = usbvision_nr++;
  1524. usbvision->have_tuner = usbvision_device_data[model].Tuner;
  1525. if (usbvision->have_tuner) {
  1526. usbvision->tuner_type = usbvision_device_data[model].TunerType;
  1527. }
  1528. usbvision->tuner_addr = ADDR_UNSET;
  1529. usbvision->DevModel = model;
  1530. usbvision->remove_pending = 0;
  1531. usbvision->iface = ifnum;
  1532. usbvision->ifaceAltInactive = 0;
  1533. usbvision->ifaceAltActive = 1;
  1534. usbvision->video_endp = endpoint->bEndpointAddress;
  1535. usbvision->isocPacketSize = 0;
  1536. usbvision->usb_bandwidth = 0;
  1537. usbvision->user = 0;
  1538. usbvision->streaming = Stream_Off;
  1539. usbvision_register_video(usbvision);
  1540. usbvision_configure_video(usbvision);
  1541. up(&usbvision->lock);
  1542. usb_set_intfdata (intf, usbvision);
  1543. usbvision_create_sysfs(usbvision->vdev);
  1544. PDEBUG(DBG_PROBE, "success");
  1545. return 0;
  1546. }
  1547. /*
  1548. * usbvision_disconnect()
  1549. *
  1550. * This procedure stops all driver activity, deallocates interface-private
  1551. * structure (pointed by 'ptr') and after that driver should be removable
  1552. * with no ill consequences.
  1553. *
  1554. */
  1555. static void __devexit usbvision_disconnect(struct usb_interface *intf)
  1556. {
  1557. struct usb_usbvision *usbvision = usb_get_intfdata(intf);
  1558. PDEBUG(DBG_PROBE, "");
  1559. if (usbvision == NULL) {
  1560. err("%s: usb_get_intfdata() failed", __FUNCTION__);
  1561. return;
  1562. }
  1563. usb_set_intfdata (intf, NULL);
  1564. down(&usbvision->lock);
  1565. // At this time we ask to cancel outstanding URBs
  1566. usbvision_stop_isoc(usbvision);
  1567. if (usbvision->power) {
  1568. usbvision_i2c_usb_del_bus(&usbvision->i2c_adap);
  1569. usbvision_power_off(usbvision);
  1570. }
  1571. usbvision->remove_pending = 1; // Now all ISO data will be ignored
  1572. usb_put_dev(usbvision->dev);
  1573. usbvision->dev = NULL; // USB device is no more
  1574. up(&usbvision->lock);
  1575. if (usbvision->user) {
  1576. info("%s: In use, disconnect pending", __FUNCTION__);
  1577. wake_up_interruptible(&usbvision->wait_frame);
  1578. wake_up_interruptible(&usbvision->wait_stream);
  1579. }
  1580. else {
  1581. usbvision_release(usbvision);
  1582. }
  1583. PDEBUG(DBG_PROBE, "success");
  1584. }
  1585. static struct usb_driver usbvision_driver = {
  1586. .name = "usbvision",
  1587. .id_table = usbvision_table,
  1588. .probe = usbvision_probe,
  1589. .disconnect = usbvision_disconnect
  1590. };
  1591. /*
  1592. * customdevice_process()
  1593. *
  1594. * This procedure preprocesses CustomDevice parameter if any
  1595. *
  1596. */
  1597. static void customdevice_process(void)
  1598. {
  1599. usbvision_device_data[0]=usbvision_device_data[1];
  1600. usbvision_table[0]=usbvision_table[1];
  1601. if(CustomDevice)
  1602. {
  1603. char *parse=CustomDevice;
  1604. PDEBUG(DBG_PROBE, "CustomDevide=%s", CustomDevice);
  1605. /*format is CustomDevice="0x0573 0x4D31 0 7113 3 PAL 1 1 1 5 -1 -1 -1 -1 -1"
  1606. usbvision_device_data[0].idVendor;
  1607. usbvision_device_data[0].idProduct;
  1608. usbvision_device_data[0].Interface;
  1609. usbvision_device_data[0].Codec;
  1610. usbvision_device_data[0].VideoChannels;
  1611. usbvision_device_data[0].VideoNorm;
  1612. usbvision_device_data[0].AudioChannels;
  1613. usbvision_device_data[0].Radio;
  1614. usbvision_device_data[0].Tuner;
  1615. usbvision_device_data[0].TunerType;
  1616. usbvision_device_data[0].Vin_Reg1;
  1617. usbvision_device_data[0].Vin_Reg2;
  1618. usbvision_device_data[0].X_Offset;
  1619. usbvision_device_data[0].Y_Offset;
  1620. usbvision_device_data[0].Dvi_yuv;
  1621. usbvision_device_data[0].ModelString;
  1622. */
  1623. rmspace(parse);
  1624. usbvision_device_data[0].ModelString="USBVISION Custom Device";
  1625. parse+=2;
  1626. sscanf(parse,"%x",&usbvision_device_data[0].idVendor);
  1627. goto2next(parse);
  1628. PDEBUG(DBG_PROBE, "idVendor=0x%.4X", usbvision_device_data[0].idVendor);
  1629. parse+=2;
  1630. sscanf(parse,"%x",&usbvision_device_data[0].idProduct);
  1631. goto2next(parse);
  1632. PDEBUG(DBG_PROBE, "idProduct=0x%.4X", usbvision_device_data[0].idProduct);
  1633. sscanf(parse,"%d",&usbvision_device_data[0].Interface);
  1634. goto2next(parse);
  1635. PDEBUG(DBG_PROBE, "Interface=%d", usbvision_device_data[0].Interface);
  1636. sscanf(parse,"%d",&usbvision_device_data[0].Codec);
  1637. goto2next(parse);
  1638. PDEBUG(DBG_PROBE, "Codec=%d", usbvision_device_data[0].Codec);
  1639. sscanf(parse,"%d",&usbvision_device_data[0].VideoChannels);
  1640. goto2next(parse);
  1641. PDEBUG(DBG_PROBE, "VideoChannels=%d", usbvision_device_data[0].VideoChannels);
  1642. switch(*parse)
  1643. {
  1644. case 'P':
  1645. PDEBUG(DBG_PROBE, "VideoNorm=PAL");
  1646. usbvision_device_data[0].VideoNorm=VIDEO_MODE_PAL;
  1647. break;
  1648. case 'S':
  1649. PDEBUG(DBG_PROBE, "VideoNorm=SECAM");
  1650. usbvision_device_data[0].VideoNorm=VIDEO_MODE_SECAM;
  1651. break;
  1652. case 'N':
  1653. PDEBUG(DBG_PROBE, "VideoNorm=NTSC");
  1654. usbvision_device_data[0].VideoNorm=VIDEO_MODE_NTSC;
  1655. break;
  1656. default:
  1657. PDEBUG(DBG_PROBE, "VideoNorm=PAL (by default)");
  1658. usbvision_device_data[0].VideoNorm=VIDEO_MODE_PAL;
  1659. break;
  1660. }
  1661. goto2next(parse);
  1662. sscanf(parse,"%d",&usbvision_device_data[0].AudioChannels);
  1663. goto2next(parse);
  1664. PDEBUG(DBG_PROBE, "AudioChannels=%d", usbvision_device_data[0].AudioChannels);
  1665. sscanf(parse,"%d",&usbvision_device_data[0].Radio);
  1666. goto2next(parse);
  1667. PDEBUG(DBG_PROBE, "Radio=%d", usbvision_device_data[0].Radio);
  1668. sscanf(parse,"%d",&usbvision_device_data[0].Tuner);
  1669. goto2next(parse);
  1670. PDEBUG(DBG_PROBE, "Tuner=%d", usbvision_device_data[0].Tuner);
  1671. sscanf(parse,"%d",&usbvision_device_data[0].TunerType);
  1672. goto2next(parse);
  1673. PDEBUG(DBG_PROBE, "TunerType=%d", usbvision_device_data[0].TunerType);
  1674. sscanf(parse,"%d",&usbvision_device_data[0].Vin_Reg1);
  1675. goto2next(parse);
  1676. PDEBUG(DBG_PROBE, "Vin_Reg1=%d", usbvision_device_data[0].Vin_Reg1);
  1677. sscanf(parse,"%d",&usbvision_device_data[0].Vin_Reg2);
  1678. goto2next(parse);
  1679. PDEBUG(DBG_PROBE, "Vin_Reg2=%d", usbvision_device_data[0].Vin_Reg2);
  1680. sscanf(parse,"%d",&usbvision_device_data[0].X_Offset);
  1681. goto2next(parse);
  1682. PDEBUG(DBG_PROBE, "X_Offset=%d", usbvision_device_data[0].X_Offset);
  1683. sscanf(parse,"%d",&usbvision_device_data[0].Y_Offset);
  1684. goto2next(parse);
  1685. PDEBUG(DBG_PROBE, "Y_Offset=%d", usbvision_device_data[0].Y_Offset);
  1686. sscanf(parse,"%d",&usbvision_device_data[0].Dvi_yuv);
  1687. PDEBUG(DBG_PROBE, "Dvi_yuv=%d", usbvision_device_data[0].Dvi_yuv);
  1688. //add to usbvision_table also
  1689. usbvision_table[0].match_flags=USB_DEVICE_ID_MATCH_DEVICE;
  1690. usbvision_table[0].idVendor=usbvision_device_data[0].idVendor;
  1691. usbvision_table[0].idProduct=usbvision_device_data[0].idProduct;
  1692. }
  1693. }
  1694. /*
  1695. * usbvision_init()
  1696. *
  1697. * This code is run to initialize the driver.
  1698. *
  1699. */
  1700. static int __init usbvision_init(void)
  1701. {
  1702. int errCode;
  1703. PDEBUG(DBG_PROBE, "");
  1704. PDEBUG(DBG_IOCTL, "IOCTL debugging is enabled [video]");
  1705. PDEBUG(DBG_IO, "IO debugging is enabled [video]");
  1706. PDEBUG(DBG_PROBE, "PROBE debugging is enabled [video]");
  1707. PDEBUG(DBG_MMAP, "MMAP debugging is enabled [video]");
  1708. /* disable planar mode support unless compression enabled */
  1709. if (isocMode != ISOC_MODE_COMPRESS ) {
  1710. // FIXME : not the right way to set supported flag
  1711. usbvision_v4l2_format[6].supported = 0; // V4L2_PIX_FMT_YVU420
  1712. usbvision_v4l2_format[7].supported = 0; // V4L2_PIX_FMT_YUV422P
  1713. }
  1714. customdevice_process();
  1715. errCode = usb_register(&usbvision_driver);
  1716. if (errCode == 0) {
  1717. info(DRIVER_DESC " : " USBVISION_VERSION_STRING);
  1718. PDEBUG(DBG_PROBE, "success");
  1719. }
  1720. return errCode;
  1721. }
  1722. static void __exit usbvision_exit(void)
  1723. {
  1724. PDEBUG(DBG_PROBE, "");
  1725. usb_deregister(&usbvision_driver);
  1726. PDEBUG(DBG_PROBE, "success");
  1727. }
  1728. module_init(usbvision_init);
  1729. module_exit(usbvision_exit);
  1730. /*
  1731. * Overrides for Emacs so that we follow Linus's tabbing style.
  1732. * ---------------------------------------------------------------------------
  1733. * Local variables:
  1734. * c-basic-offset: 8
  1735. * End:
  1736. */