cpia2_core.c 72 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528152915301531153215331534153515361537153815391540154115421543154415451546154715481549155015511552155315541555155615571558155915601561156215631564156515661567156815691570157115721573157415751576157715781579158015811582158315841585158615871588158915901591159215931594159515961597159815991600160116021603160416051606160716081609161016111612161316141615161616171618161916201621162216231624162516261627162816291630163116321633163416351636163716381639164016411642164316441645164616471648164916501651165216531654165516561657165816591660166116621663166416651666166716681669167016711672167316741675167616771678167916801681168216831684168516861687168816891690169116921693169416951696169716981699170017011702170317041705170617071708170917101711171217131714171517161717171817191720172117221723172417251726172717281729173017311732173317341735173617371738173917401741174217431744174517461747174817491750175117521753175417551756175717581759176017611762176317641765176617671768176917701771177217731774177517761777177817791780178117821783178417851786178717881789179017911792179317941795179617971798179918001801180218031804180518061807180818091810181118121813181418151816181718181819182018211822182318241825182618271828182918301831183218331834183518361837183818391840184118421843184418451846184718481849185018511852185318541855185618571858185918601861186218631864186518661867186818691870187118721873187418751876187718781879188018811882188318841885188618871888188918901891189218931894189518961897189818991900190119021903190419051906190719081909191019111912191319141915191619171918191919201921192219231924192519261927192819291930193119321933193419351936193719381939194019411942194319441945194619471948194919501951195219531954195519561957195819591960196119621963196419651966196719681969197019711972197319741975197619771978197919801981198219831984198519861987198819891990199119921993199419951996199719981999200020012002200320042005200620072008200920102011201220132014201520162017201820192020202120222023202420252026202720282029203020312032203320342035203620372038203920402041204220432044204520462047204820492050205120522053205420552056205720582059206020612062206320642065206620672068206920702071207220732074207520762077207820792080208120822083208420852086208720882089209020912092209320942095209620972098209921002101210221032104210521062107210821092110211121122113211421152116211721182119212021212122212321242125212621272128212921302131213221332134213521362137213821392140214121422143214421452146214721482149215021512152215321542155215621572158215921602161216221632164216521662167216821692170217121722173217421752176217721782179218021812182218321842185218621872188218921902191219221932194219521962197219821992200220122022203220422052206220722082209221022112212221322142215221622172218221922202221222222232224222522262227222822292230223122322233223422352236223722382239224022412242224322442245224622472248224922502251225222532254225522562257225822592260226122622263226422652266226722682269227022712272227322742275227622772278227922802281228222832284228522862287228822892290229122922293229422952296229722982299230023012302230323042305230623072308230923102311231223132314231523162317231823192320232123222323232423252326232723282329233023312332233323342335233623372338233923402341234223432344234523462347234823492350235123522353235423552356235723582359236023612362236323642365236623672368236923702371237223732374237523762377237823792380238123822383238423852386238723882389239023912392239323942395239623972398239924002401240224032404240524062407240824092410241124122413241424152416241724182419242024212422242324242425242624272428242924302431
  1. /****************************************************************************
  2. *
  3. * Filename: cpia2_core.c
  4. *
  5. * Copyright 2001, STMicrolectronics, Inc.
  6. * Contact: steve.miller@st.com
  7. *
  8. * Description:
  9. * This is a USB driver for CPia2 based video cameras.
  10. * The infrastructure of this driver is based on the cpia usb driver by
  11. * Jochen Scharrlach and Johannes Erdfeldt.
  12. *
  13. * This program is free software; you can redistribute it and/or modify
  14. * it under the terms of the GNU General Public License as published by
  15. * the Free Software Foundation; either version 2 of the License, or
  16. * (at your option) any later version.
  17. *
  18. * This program is distributed in the hope that it will be useful,
  19. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  20. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  21. * GNU General Public License for more details.
  22. *
  23. * Stripped of 2.4 stuff ready for main kernel submit by
  24. * Alan Cox <alan@lxorguk.ukuu.org.uk>
  25. *
  26. ****************************************************************************/
  27. #include "cpia2.h"
  28. #include <linux/module.h>
  29. #include <linux/slab.h>
  30. #include <linux/mm.h>
  31. #include <linux/vmalloc.h>
  32. #include <linux/firmware.h>
  33. #include <linux/sched/signal.h>
  34. #define FIRMWARE "cpia2/stv0672_vp4.bin"
  35. MODULE_FIRMWARE(FIRMWARE);
  36. /* #define _CPIA2_DEBUG_ */
  37. #ifdef _CPIA2_DEBUG_
  38. static const char *block_name[] = {
  39. "System",
  40. "VC",
  41. "VP",
  42. "IDATA"
  43. };
  44. #endif
  45. static unsigned int debugs_on; /* default 0 - DEBUG_REG */
  46. /******************************************************************************
  47. *
  48. * Forward Declarations
  49. *
  50. *****************************************************************************/
  51. static int apply_vp_patch(struct camera_data *cam);
  52. static int set_default_user_mode(struct camera_data *cam);
  53. static int set_vw_size(struct camera_data *cam, int size);
  54. static int configure_sensor(struct camera_data *cam,
  55. int reqwidth, int reqheight);
  56. static int config_sensor_410(struct camera_data *cam,
  57. int reqwidth, int reqheight);
  58. static int config_sensor_500(struct camera_data *cam,
  59. int reqwidth, int reqheight);
  60. static int set_all_properties(struct camera_data *cam);
  61. static void wake_system(struct camera_data *cam);
  62. static void set_lowlight_boost(struct camera_data *cam);
  63. static void reset_camera_struct(struct camera_data *cam);
  64. static int cpia2_set_high_power(struct camera_data *cam);
  65. /* Here we want the physical address of the memory.
  66. * This is used when initializing the contents of the
  67. * area and marking the pages as reserved.
  68. */
  69. static inline unsigned long kvirt_to_pa(unsigned long adr)
  70. {
  71. unsigned long kva, ret;
  72. kva = (unsigned long) page_address(vmalloc_to_page((void *)adr));
  73. kva |= adr & (PAGE_SIZE-1); /* restore the offset */
  74. ret = __pa(kva);
  75. return ret;
  76. }
  77. static void *rvmalloc(unsigned long size)
  78. {
  79. void *mem;
  80. unsigned long adr;
  81. /* Round it off to PAGE_SIZE */
  82. size = PAGE_ALIGN(size);
  83. mem = vmalloc_32(size);
  84. if (!mem)
  85. return NULL;
  86. memset(mem, 0, size); /* Clear the ram out, no junk to the user */
  87. adr = (unsigned long) mem;
  88. while ((long)size > 0) {
  89. SetPageReserved(vmalloc_to_page((void *)adr));
  90. adr += PAGE_SIZE;
  91. size -= PAGE_SIZE;
  92. }
  93. return mem;
  94. }
  95. static void rvfree(void *mem, unsigned long size)
  96. {
  97. unsigned long adr;
  98. if (!mem)
  99. return;
  100. size = PAGE_ALIGN(size);
  101. adr = (unsigned long) mem;
  102. while ((long)size > 0) {
  103. ClearPageReserved(vmalloc_to_page((void *)adr));
  104. adr += PAGE_SIZE;
  105. size -= PAGE_SIZE;
  106. }
  107. vfree(mem);
  108. }
  109. /******************************************************************************
  110. *
  111. * cpia2_do_command
  112. *
  113. * Send an arbitrary command to the camera. For commands that read from
  114. * the camera, copy the buffers into the proper param structures.
  115. *****************************************************************************/
  116. int cpia2_do_command(struct camera_data *cam,
  117. u32 command, u8 direction, u8 param)
  118. {
  119. int retval = 0;
  120. struct cpia2_command cmd;
  121. unsigned int device = cam->params.pnp_id.device_type;
  122. cmd.command = command;
  123. cmd.reg_count = 2; /* default */
  124. cmd.direction = direction;
  125. /***
  126. * Set up the command.
  127. ***/
  128. switch (command) {
  129. case CPIA2_CMD_GET_VERSION:
  130. cmd.req_mode =
  131. CAMERAACCESS_TYPE_BLOCK | CAMERAACCESS_SYSTEM;
  132. cmd.start = CPIA2_SYSTEM_DEVICE_HI;
  133. break;
  134. case CPIA2_CMD_GET_PNP_ID:
  135. cmd.req_mode =
  136. CAMERAACCESS_TYPE_BLOCK | CAMERAACCESS_SYSTEM;
  137. cmd.reg_count = 8;
  138. cmd.start = CPIA2_SYSTEM_DESCRIP_VID_HI;
  139. break;
  140. case CPIA2_CMD_GET_ASIC_TYPE:
  141. cmd.req_mode = CAMERAACCESS_TYPE_BLOCK | CAMERAACCESS_VC;
  142. cmd.start = CPIA2_VC_ASIC_ID;
  143. break;
  144. case CPIA2_CMD_GET_SENSOR:
  145. cmd.req_mode = CAMERAACCESS_TYPE_BLOCK | CAMERAACCESS_VP;
  146. cmd.start = CPIA2_VP_SENSOR_FLAGS;
  147. break;
  148. case CPIA2_CMD_GET_VP_DEVICE:
  149. cmd.req_mode = CAMERAACCESS_TYPE_BLOCK | CAMERAACCESS_VP;
  150. cmd.start = CPIA2_VP_DEVICEH;
  151. break;
  152. case CPIA2_CMD_SET_VP_BRIGHTNESS:
  153. cmd.buffer.block_data[0] = param;
  154. /* fall through */
  155. case CPIA2_CMD_GET_VP_BRIGHTNESS:
  156. cmd.req_mode = CAMERAACCESS_TYPE_BLOCK | CAMERAACCESS_VP;
  157. cmd.reg_count = 1;
  158. if (device == DEVICE_STV_672)
  159. cmd.start = CPIA2_VP4_EXPOSURE_TARGET;
  160. else
  161. cmd.start = CPIA2_VP5_EXPOSURE_TARGET;
  162. break;
  163. case CPIA2_CMD_SET_CONTRAST:
  164. cmd.buffer.block_data[0] = param;
  165. /* fall through */
  166. case CPIA2_CMD_GET_CONTRAST:
  167. cmd.req_mode = CAMERAACCESS_TYPE_BLOCK | CAMERAACCESS_VP;
  168. cmd.reg_count = 1;
  169. cmd.start = CPIA2_VP_YRANGE;
  170. break;
  171. case CPIA2_CMD_SET_VP_SATURATION:
  172. cmd.buffer.block_data[0] = param;
  173. /* fall through */
  174. case CPIA2_CMD_GET_VP_SATURATION:
  175. cmd.req_mode = CAMERAACCESS_TYPE_BLOCK | CAMERAACCESS_VP;
  176. cmd.reg_count = 1;
  177. if (device == DEVICE_STV_672)
  178. cmd.start = CPIA2_VP_SATURATION;
  179. else
  180. cmd.start = CPIA2_VP5_MCUVSATURATION;
  181. break;
  182. case CPIA2_CMD_SET_VP_GPIO_DATA:
  183. cmd.buffer.block_data[0] = param;
  184. /* fall through */
  185. case CPIA2_CMD_GET_VP_GPIO_DATA:
  186. cmd.req_mode = CAMERAACCESS_TYPE_BLOCK | CAMERAACCESS_VP;
  187. cmd.reg_count = 1;
  188. cmd.start = CPIA2_VP_GPIO_DATA;
  189. break;
  190. case CPIA2_CMD_SET_VP_GPIO_DIRECTION:
  191. cmd.buffer.block_data[0] = param;
  192. /* fall through */
  193. case CPIA2_CMD_GET_VP_GPIO_DIRECTION:
  194. cmd.req_mode = CAMERAACCESS_TYPE_BLOCK | CAMERAACCESS_VP;
  195. cmd.reg_count = 1;
  196. cmd.start = CPIA2_VP_GPIO_DIRECTION;
  197. break;
  198. case CPIA2_CMD_SET_VC_MP_GPIO_DATA:
  199. cmd.buffer.block_data[0] = param;
  200. /* fall through */
  201. case CPIA2_CMD_GET_VC_MP_GPIO_DATA:
  202. cmd.req_mode = CAMERAACCESS_TYPE_BLOCK | CAMERAACCESS_VC;
  203. cmd.reg_count = 1;
  204. cmd.start = CPIA2_VC_MP_DATA;
  205. break;
  206. case CPIA2_CMD_SET_VC_MP_GPIO_DIRECTION:
  207. cmd.buffer.block_data[0] = param;
  208. /*fall through */
  209. case CPIA2_CMD_GET_VC_MP_GPIO_DIRECTION:
  210. cmd.req_mode = CAMERAACCESS_TYPE_BLOCK | CAMERAACCESS_VC;
  211. cmd.reg_count = 1;
  212. cmd.start = CPIA2_VC_MP_DIR;
  213. break;
  214. case CPIA2_CMD_ENABLE_PACKET_CTRL:
  215. cmd.req_mode =
  216. CAMERAACCESS_TYPE_BLOCK | CAMERAACCESS_SYSTEM;
  217. cmd.start = CPIA2_SYSTEM_INT_PACKET_CTRL;
  218. cmd.reg_count = 1;
  219. cmd.buffer.block_data[0] = param;
  220. break;
  221. case CPIA2_CMD_SET_FLICKER_MODES:
  222. cmd.buffer.block_data[0] = param;
  223. /* fall through */
  224. case CPIA2_CMD_GET_FLICKER_MODES:
  225. cmd.req_mode = CAMERAACCESS_TYPE_BLOCK | CAMERAACCESS_VP;
  226. cmd.reg_count = 1;
  227. cmd.start = CPIA2_VP_FLICKER_MODES;
  228. break;
  229. case CPIA2_CMD_RESET_FIFO: /* clear fifo and enable stream block */
  230. cmd.req_mode = CAMERAACCESS_TYPE_RANDOM | CAMERAACCESS_VC;
  231. cmd.reg_count = 2;
  232. cmd.start = 0;
  233. cmd.buffer.registers[0].index = CPIA2_VC_ST_CTRL;
  234. cmd.buffer.registers[0].value = CPIA2_VC_ST_CTRL_SRC_VC |
  235. CPIA2_VC_ST_CTRL_DST_USB | CPIA2_VC_ST_CTRL_EOF_DETECT;
  236. cmd.buffer.registers[1].index = CPIA2_VC_ST_CTRL;
  237. cmd.buffer.registers[1].value = CPIA2_VC_ST_CTRL_SRC_VC |
  238. CPIA2_VC_ST_CTRL_DST_USB |
  239. CPIA2_VC_ST_CTRL_EOF_DETECT |
  240. CPIA2_VC_ST_CTRL_FIFO_ENABLE;
  241. break;
  242. case CPIA2_CMD_SET_HI_POWER:
  243. cmd.req_mode =
  244. CAMERAACCESS_TYPE_RANDOM | CAMERAACCESS_SYSTEM;
  245. cmd.reg_count = 2;
  246. cmd.buffer.registers[0].index =
  247. CPIA2_SYSTEM_SYSTEM_CONTROL;
  248. cmd.buffer.registers[1].index =
  249. CPIA2_SYSTEM_SYSTEM_CONTROL;
  250. cmd.buffer.registers[0].value = CPIA2_SYSTEM_CONTROL_CLEAR_ERR;
  251. cmd.buffer.registers[1].value =
  252. CPIA2_SYSTEM_CONTROL_HIGH_POWER;
  253. break;
  254. case CPIA2_CMD_SET_LOW_POWER:
  255. cmd.req_mode =
  256. CAMERAACCESS_TYPE_BLOCK | CAMERAACCESS_SYSTEM;
  257. cmd.reg_count = 1;
  258. cmd.start = CPIA2_SYSTEM_SYSTEM_CONTROL;
  259. cmd.buffer.block_data[0] = 0;
  260. break;
  261. case CPIA2_CMD_CLEAR_V2W_ERR:
  262. cmd.req_mode =
  263. CAMERAACCESS_TYPE_BLOCK | CAMERAACCESS_SYSTEM;
  264. cmd.reg_count = 1;
  265. cmd.start = CPIA2_SYSTEM_SYSTEM_CONTROL;
  266. cmd.buffer.block_data[0] = CPIA2_SYSTEM_CONTROL_CLEAR_ERR;
  267. break;
  268. case CPIA2_CMD_SET_USER_MODE:
  269. cmd.buffer.block_data[0] = param;
  270. /* fall through */
  271. case CPIA2_CMD_GET_USER_MODE:
  272. cmd.req_mode = CAMERAACCESS_TYPE_BLOCK | CAMERAACCESS_VP;
  273. cmd.reg_count = 1;
  274. if (device == DEVICE_STV_672)
  275. cmd.start = CPIA2_VP4_USER_MODE;
  276. else
  277. cmd.start = CPIA2_VP5_USER_MODE;
  278. break;
  279. case CPIA2_CMD_FRAMERATE_REQ:
  280. cmd.req_mode = CAMERAACCESS_TYPE_BLOCK | CAMERAACCESS_VP;
  281. cmd.reg_count = 1;
  282. if (device == DEVICE_STV_672)
  283. cmd.start = CPIA2_VP4_FRAMERATE_REQUEST;
  284. else
  285. cmd.start = CPIA2_VP5_FRAMERATE_REQUEST;
  286. cmd.buffer.block_data[0] = param;
  287. break;
  288. case CPIA2_CMD_SET_WAKEUP:
  289. cmd.buffer.block_data[0] = param;
  290. /* fall through */
  291. case CPIA2_CMD_GET_WAKEUP:
  292. cmd.req_mode = CAMERAACCESS_TYPE_BLOCK | CAMERAACCESS_VC;
  293. cmd.reg_count = 1;
  294. cmd.start = CPIA2_VC_WAKEUP;
  295. break;
  296. case CPIA2_CMD_SET_PW_CONTROL:
  297. cmd.buffer.block_data[0] = param;
  298. /* fall through */
  299. case CPIA2_CMD_GET_PW_CONTROL:
  300. cmd.req_mode = CAMERAACCESS_TYPE_BLOCK | CAMERAACCESS_VC;
  301. cmd.reg_count = 1;
  302. cmd.start = CPIA2_VC_PW_CTRL;
  303. break;
  304. case CPIA2_CMD_GET_VP_SYSTEM_STATE:
  305. cmd.req_mode = CAMERAACCESS_TYPE_BLOCK | CAMERAACCESS_VP;
  306. cmd.reg_count = 1;
  307. cmd.start = CPIA2_VP_SYSTEMSTATE;
  308. break;
  309. case CPIA2_CMD_SET_SYSTEM_CTRL:
  310. cmd.buffer.block_data[0] = param;
  311. /* fall through */
  312. case CPIA2_CMD_GET_SYSTEM_CTRL:
  313. cmd.req_mode =
  314. CAMERAACCESS_TYPE_BLOCK | CAMERAACCESS_SYSTEM;
  315. cmd.reg_count = 1;
  316. cmd.start = CPIA2_SYSTEM_SYSTEM_CONTROL;
  317. break;
  318. case CPIA2_CMD_SET_VP_SYSTEM_CTRL:
  319. cmd.buffer.block_data[0] = param;
  320. /* fall through */
  321. case CPIA2_CMD_GET_VP_SYSTEM_CTRL:
  322. cmd.req_mode = CAMERAACCESS_TYPE_BLOCK | CAMERAACCESS_VP;
  323. cmd.reg_count = 1;
  324. cmd.start = CPIA2_VP_SYSTEMCTRL;
  325. break;
  326. case CPIA2_CMD_SET_VP_EXP_MODES:
  327. cmd.buffer.block_data[0] = param;
  328. /* fall through */
  329. case CPIA2_CMD_GET_VP_EXP_MODES:
  330. cmd.req_mode = CAMERAACCESS_TYPE_BLOCK | CAMERAACCESS_VP;
  331. cmd.reg_count = 1;
  332. cmd.start = CPIA2_VP_EXPOSURE_MODES;
  333. break;
  334. case CPIA2_CMD_SET_DEVICE_CONFIG:
  335. cmd.buffer.block_data[0] = param;
  336. /* fall through */
  337. case CPIA2_CMD_GET_DEVICE_CONFIG:
  338. cmd.req_mode = CAMERAACCESS_TYPE_BLOCK | CAMERAACCESS_VP;
  339. cmd.reg_count = 1;
  340. cmd.start = CPIA2_VP_DEVICE_CONFIG;
  341. break;
  342. case CPIA2_CMD_SET_SERIAL_ADDR:
  343. cmd.buffer.block_data[0] = param;
  344. cmd.req_mode =
  345. CAMERAACCESS_TYPE_BLOCK | CAMERAACCESS_SYSTEM;
  346. cmd.reg_count = 1;
  347. cmd.start = CPIA2_SYSTEM_VP_SERIAL_ADDR;
  348. break;
  349. case CPIA2_CMD_SET_SENSOR_CR1:
  350. cmd.buffer.block_data[0] = param;
  351. cmd.req_mode = CAMERAACCESS_TYPE_BLOCK | CAMERAACCESS_VP;
  352. cmd.reg_count = 1;
  353. cmd.start = CPIA2_SENSOR_CR1;
  354. break;
  355. case CPIA2_CMD_SET_VC_CONTROL:
  356. cmd.buffer.block_data[0] = param;
  357. /* fall through */
  358. case CPIA2_CMD_GET_VC_CONTROL:
  359. cmd.req_mode = CAMERAACCESS_TYPE_BLOCK | CAMERAACCESS_VC;
  360. cmd.reg_count = 1;
  361. cmd.start = CPIA2_VC_VC_CTRL;
  362. break;
  363. case CPIA2_CMD_SET_TARGET_KB:
  364. cmd.req_mode = CAMERAACCESS_TYPE_RANDOM | CAMERAACCESS_VC;
  365. cmd.reg_count = 1;
  366. cmd.buffer.registers[0].index = CPIA2_VC_VC_TARGET_KB;
  367. cmd.buffer.registers[0].value = param;
  368. break;
  369. case CPIA2_CMD_SET_DEF_JPEG_OPT:
  370. cmd.req_mode = CAMERAACCESS_TYPE_RANDOM | CAMERAACCESS_VC;
  371. cmd.reg_count = 4;
  372. cmd.buffer.registers[0].index = CPIA2_VC_VC_JPEG_OPT;
  373. cmd.buffer.registers[0].value =
  374. CPIA2_VC_VC_JPEG_OPT_DOUBLE_SQUEEZE;
  375. cmd.buffer.registers[1].index = CPIA2_VC_VC_USER_SQUEEZE;
  376. cmd.buffer.registers[1].value = 20;
  377. cmd.buffer.registers[2].index = CPIA2_VC_VC_CREEP_PERIOD;
  378. cmd.buffer.registers[2].value = 2;
  379. cmd.buffer.registers[3].index = CPIA2_VC_VC_JPEG_OPT;
  380. cmd.buffer.registers[3].value = CPIA2_VC_VC_JPEG_OPT_DEFAULT;
  381. break;
  382. case CPIA2_CMD_REHASH_VP4:
  383. cmd.req_mode = CAMERAACCESS_TYPE_BLOCK | CAMERAACCESS_VP;
  384. cmd.reg_count = 1;
  385. cmd.start = CPIA2_VP_REHASH_VALUES;
  386. cmd.buffer.block_data[0] = param;
  387. break;
  388. case CPIA2_CMD_SET_USER_EFFECTS: /* Note: Be careful with this as
  389. this register can also affect
  390. flicker modes */
  391. cmd.buffer.block_data[0] = param;
  392. /* fall through */
  393. case CPIA2_CMD_GET_USER_EFFECTS:
  394. cmd.req_mode = CAMERAACCESS_TYPE_BLOCK | CAMERAACCESS_VP;
  395. cmd.reg_count = 1;
  396. if (device == DEVICE_STV_672)
  397. cmd.start = CPIA2_VP4_USER_EFFECTS;
  398. else
  399. cmd.start = CPIA2_VP5_USER_EFFECTS;
  400. break;
  401. default:
  402. LOG("DoCommand received invalid command\n");
  403. return -EINVAL;
  404. }
  405. retval = cpia2_send_command(cam, &cmd);
  406. if (retval) {
  407. return retval;
  408. }
  409. /***
  410. * Now copy any results from a read into the appropriate param struct.
  411. ***/
  412. switch (command) {
  413. case CPIA2_CMD_GET_VERSION:
  414. cam->params.version.firmware_revision_hi =
  415. cmd.buffer.block_data[0];
  416. cam->params.version.firmware_revision_lo =
  417. cmd.buffer.block_data[1];
  418. break;
  419. case CPIA2_CMD_GET_PNP_ID:
  420. cam->params.pnp_id.vendor = (cmd.buffer.block_data[0] << 8) |
  421. cmd.buffer.block_data[1];
  422. cam->params.pnp_id.product = (cmd.buffer.block_data[2] << 8) |
  423. cmd.buffer.block_data[3];
  424. cam->params.pnp_id.device_revision =
  425. (cmd.buffer.block_data[4] << 8) |
  426. cmd.buffer.block_data[5];
  427. if (cam->params.pnp_id.vendor == 0x553) {
  428. if (cam->params.pnp_id.product == 0x100) {
  429. cam->params.pnp_id.device_type = DEVICE_STV_672;
  430. } else if (cam->params.pnp_id.product == 0x140 ||
  431. cam->params.pnp_id.product == 0x151) {
  432. cam->params.pnp_id.device_type = DEVICE_STV_676;
  433. }
  434. }
  435. break;
  436. case CPIA2_CMD_GET_ASIC_TYPE:
  437. cam->params.version.asic_id = cmd.buffer.block_data[0];
  438. cam->params.version.asic_rev = cmd.buffer.block_data[1];
  439. break;
  440. case CPIA2_CMD_GET_SENSOR:
  441. cam->params.version.sensor_flags = cmd.buffer.block_data[0];
  442. cam->params.version.sensor_rev = cmd.buffer.block_data[1];
  443. break;
  444. case CPIA2_CMD_GET_VP_DEVICE:
  445. cam->params.version.vp_device_hi = cmd.buffer.block_data[0];
  446. cam->params.version.vp_device_lo = cmd.buffer.block_data[1];
  447. break;
  448. case CPIA2_CMD_GET_VP_GPIO_DATA:
  449. cam->params.vp_params.gpio_data = cmd.buffer.block_data[0];
  450. break;
  451. case CPIA2_CMD_GET_VP_GPIO_DIRECTION:
  452. cam->params.vp_params.gpio_direction = cmd.buffer.block_data[0];
  453. break;
  454. case CPIA2_CMD_GET_VC_MP_GPIO_DIRECTION:
  455. cam->params.vc_params.vc_mp_direction =cmd.buffer.block_data[0];
  456. break;
  457. case CPIA2_CMD_GET_VC_MP_GPIO_DATA:
  458. cam->params.vc_params.vc_mp_data = cmd.buffer.block_data[0];
  459. break;
  460. case CPIA2_CMD_GET_FLICKER_MODES:
  461. cam->params.flicker_control.cam_register =
  462. cmd.buffer.block_data[0];
  463. break;
  464. case CPIA2_CMD_GET_WAKEUP:
  465. cam->params.vc_params.wakeup = cmd.buffer.block_data[0];
  466. break;
  467. case CPIA2_CMD_GET_PW_CONTROL:
  468. cam->params.vc_params.pw_control = cmd.buffer.block_data[0];
  469. break;
  470. case CPIA2_CMD_GET_SYSTEM_CTRL:
  471. cam->params.camera_state.system_ctrl = cmd.buffer.block_data[0];
  472. break;
  473. case CPIA2_CMD_GET_VP_SYSTEM_STATE:
  474. cam->params.vp_params.system_state = cmd.buffer.block_data[0];
  475. break;
  476. case CPIA2_CMD_GET_VP_SYSTEM_CTRL:
  477. cam->params.vp_params.system_ctrl = cmd.buffer.block_data[0];
  478. break;
  479. case CPIA2_CMD_GET_VP_EXP_MODES:
  480. cam->params.vp_params.exposure_modes = cmd.buffer.block_data[0];
  481. break;
  482. case CPIA2_CMD_GET_DEVICE_CONFIG:
  483. cam->params.vp_params.device_config = cmd.buffer.block_data[0];
  484. break;
  485. case CPIA2_CMD_GET_VC_CONTROL:
  486. cam->params.vc_params.vc_control = cmd.buffer.block_data[0];
  487. break;
  488. case CPIA2_CMD_GET_USER_MODE:
  489. cam->params.vp_params.video_mode = cmd.buffer.block_data[0];
  490. break;
  491. case CPIA2_CMD_GET_USER_EFFECTS:
  492. cam->params.vp_params.user_effects = cmd.buffer.block_data[0];
  493. break;
  494. default:
  495. break;
  496. }
  497. return retval;
  498. }
  499. /******************************************************************************
  500. *
  501. * cpia2_send_command
  502. *
  503. *****************************************************************************/
  504. #define DIR(cmd) ((cmd->direction == TRANSFER_WRITE) ? "Write" : "Read")
  505. #define BINDEX(cmd) (cmd->req_mode & 0x03)
  506. int cpia2_send_command(struct camera_data *cam, struct cpia2_command *cmd)
  507. {
  508. u8 count;
  509. u8 start;
  510. u8 *buffer;
  511. int retval;
  512. switch (cmd->req_mode & 0x0c) {
  513. case CAMERAACCESS_TYPE_RANDOM:
  514. count = cmd->reg_count * sizeof(struct cpia2_register);
  515. start = 0;
  516. buffer = (u8 *) & cmd->buffer;
  517. if (debugs_on & DEBUG_REG)
  518. DBG("%s Random: Register block %s\n", DIR(cmd),
  519. block_name[BINDEX(cmd)]);
  520. break;
  521. case CAMERAACCESS_TYPE_BLOCK:
  522. count = cmd->reg_count;
  523. start = cmd->start;
  524. buffer = cmd->buffer.block_data;
  525. if (debugs_on & DEBUG_REG)
  526. DBG("%s Block: Register block %s\n", DIR(cmd),
  527. block_name[BINDEX(cmd)]);
  528. break;
  529. case CAMERAACCESS_TYPE_MASK:
  530. count = cmd->reg_count * sizeof(struct cpia2_reg_mask);
  531. start = 0;
  532. buffer = (u8 *) & cmd->buffer;
  533. if (debugs_on & DEBUG_REG)
  534. DBG("%s Mask: Register block %s\n", DIR(cmd),
  535. block_name[BINDEX(cmd)]);
  536. break;
  537. case CAMERAACCESS_TYPE_REPEAT: /* For patch blocks only */
  538. count = cmd->reg_count;
  539. start = cmd->start;
  540. buffer = cmd->buffer.block_data;
  541. if (debugs_on & DEBUG_REG)
  542. DBG("%s Repeat: Register block %s\n", DIR(cmd),
  543. block_name[BINDEX(cmd)]);
  544. break;
  545. default:
  546. LOG("%s: invalid request mode\n",__func__);
  547. return -EINVAL;
  548. }
  549. retval = cpia2_usb_transfer_cmd(cam,
  550. buffer,
  551. cmd->req_mode,
  552. start, count, cmd->direction);
  553. #ifdef _CPIA2_DEBUG_
  554. if (debugs_on & DEBUG_REG) {
  555. int i;
  556. for (i = 0; i < cmd->reg_count; i++) {
  557. if((cmd->req_mode & 0x0c) == CAMERAACCESS_TYPE_BLOCK)
  558. KINFO("%s Block: [0x%02X] = 0x%02X\n",
  559. DIR(cmd), start + i, buffer[i]);
  560. if((cmd->req_mode & 0x0c) == CAMERAACCESS_TYPE_RANDOM)
  561. KINFO("%s Random: [0x%02X] = 0x%02X\n",
  562. DIR(cmd), cmd->buffer.registers[i].index,
  563. cmd->buffer.registers[i].value);
  564. }
  565. }
  566. #endif
  567. return retval;
  568. };
  569. /*************
  570. * Functions to implement camera functionality
  571. *************/
  572. /******************************************************************************
  573. *
  574. * cpia2_get_version_info
  575. *
  576. *****************************************************************************/
  577. static void cpia2_get_version_info(struct camera_data *cam)
  578. {
  579. cpia2_do_command(cam, CPIA2_CMD_GET_VERSION, TRANSFER_READ, 0);
  580. cpia2_do_command(cam, CPIA2_CMD_GET_PNP_ID, TRANSFER_READ, 0);
  581. cpia2_do_command(cam, CPIA2_CMD_GET_ASIC_TYPE, TRANSFER_READ, 0);
  582. cpia2_do_command(cam, CPIA2_CMD_GET_SENSOR, TRANSFER_READ, 0);
  583. cpia2_do_command(cam, CPIA2_CMD_GET_VP_DEVICE, TRANSFER_READ, 0);
  584. }
  585. /******************************************************************************
  586. *
  587. * cpia2_reset_camera
  588. *
  589. * Called at least during the open process, sets up initial params.
  590. *****************************************************************************/
  591. int cpia2_reset_camera(struct camera_data *cam)
  592. {
  593. u8 tmp_reg;
  594. int retval = 0;
  595. int target_kb;
  596. int i;
  597. struct cpia2_command cmd;
  598. /***
  599. * VC setup
  600. ***/
  601. retval = configure_sensor(cam,
  602. cam->params.roi.width,
  603. cam->params.roi.height);
  604. if (retval < 0) {
  605. ERR("Couldn't configure sensor, error=%d\n", retval);
  606. return retval;
  607. }
  608. /* Clear FIFO and route/enable stream block */
  609. cmd.req_mode = CAMERAACCESS_TYPE_RANDOM | CAMERAACCESS_VC;
  610. cmd.direction = TRANSFER_WRITE;
  611. cmd.reg_count = 2;
  612. cmd.buffer.registers[0].index = CPIA2_VC_ST_CTRL;
  613. cmd.buffer.registers[0].value = CPIA2_VC_ST_CTRL_SRC_VC |
  614. CPIA2_VC_ST_CTRL_DST_USB | CPIA2_VC_ST_CTRL_EOF_DETECT;
  615. cmd.buffer.registers[1].index = CPIA2_VC_ST_CTRL;
  616. cmd.buffer.registers[1].value = CPIA2_VC_ST_CTRL_SRC_VC |
  617. CPIA2_VC_ST_CTRL_DST_USB |
  618. CPIA2_VC_ST_CTRL_EOF_DETECT | CPIA2_VC_ST_CTRL_FIFO_ENABLE;
  619. cpia2_send_command(cam, &cmd);
  620. cpia2_set_high_power(cam);
  621. if (cam->params.pnp_id.device_type == DEVICE_STV_672) {
  622. /* Enable button notification */
  623. cmd.req_mode = CAMERAACCESS_TYPE_RANDOM | CAMERAACCESS_SYSTEM;
  624. cmd.buffer.registers[0].index = CPIA2_SYSTEM_INT_PACKET_CTRL;
  625. cmd.buffer.registers[0].value =
  626. CPIA2_SYSTEM_INT_PACKET_CTRL_ENABLE_SW_XX;
  627. cmd.reg_count = 1;
  628. cpia2_send_command(cam, &cmd);
  629. }
  630. schedule_timeout_interruptible(msecs_to_jiffies(100));
  631. if (cam->params.pnp_id.device_type == DEVICE_STV_672)
  632. retval = apply_vp_patch(cam);
  633. /* wait for vp to go to sleep */
  634. schedule_timeout_interruptible(msecs_to_jiffies(100));
  635. /***
  636. * If this is a 676, apply VP5 fixes before we start streaming
  637. ***/
  638. if (cam->params.pnp_id.device_type == DEVICE_STV_676) {
  639. cmd.req_mode = CAMERAACCESS_TYPE_RANDOM | CAMERAACCESS_VP;
  640. /* The following writes improve the picture */
  641. cmd.buffer.registers[0].index = CPIA2_VP5_MYBLACK_LEVEL;
  642. cmd.buffer.registers[0].value = 0; /* reduce from the default
  643. * rec 601 pedestal of 16 */
  644. cmd.buffer.registers[1].index = CPIA2_VP5_MCYRANGE;
  645. cmd.buffer.registers[1].value = 0x92; /* increase from 100% to
  646. * (256/256 - 31) to fill
  647. * available range */
  648. cmd.buffer.registers[2].index = CPIA2_VP5_MYCEILING;
  649. cmd.buffer.registers[2].value = 0xFF; /* Increase from the
  650. * default rec 601 ceiling
  651. * of 240 */
  652. cmd.buffer.registers[3].index = CPIA2_VP5_MCUVSATURATION;
  653. cmd.buffer.registers[3].value = 0xFF; /* Increase from the rec
  654. * 601 100% level (128)
  655. * to 145-192 */
  656. cmd.buffer.registers[4].index = CPIA2_VP5_ANTIFLKRSETUP;
  657. cmd.buffer.registers[4].value = 0x80; /* Inhibit the
  658. * anti-flicker */
  659. /* The following 4 writes are a fix to allow QVGA to work at 30 fps */
  660. cmd.buffer.registers[5].index = CPIA2_VP_RAM_ADDR_H;
  661. cmd.buffer.registers[5].value = 0x01;
  662. cmd.buffer.registers[6].index = CPIA2_VP_RAM_ADDR_L;
  663. cmd.buffer.registers[6].value = 0xE3;
  664. cmd.buffer.registers[7].index = CPIA2_VP_RAM_DATA;
  665. cmd.buffer.registers[7].value = 0x02;
  666. cmd.buffer.registers[8].index = CPIA2_VP_RAM_DATA;
  667. cmd.buffer.registers[8].value = 0xFC;
  668. cmd.direction = TRANSFER_WRITE;
  669. cmd.reg_count = 9;
  670. cpia2_send_command(cam, &cmd);
  671. }
  672. /* Activate all settings and start the data stream */
  673. /* Set user mode */
  674. set_default_user_mode(cam);
  675. /* Give VP time to wake up */
  676. schedule_timeout_interruptible(msecs_to_jiffies(100));
  677. set_all_properties(cam);
  678. cpia2_do_command(cam, CPIA2_CMD_GET_USER_MODE, TRANSFER_READ, 0);
  679. DBG("After SetAllProperties(cam), user mode is 0x%0X\n",
  680. cam->params.vp_params.video_mode);
  681. /***
  682. * Set audio regulator off. This and the code to set the compresison
  683. * state are too complex to form a CPIA2_CMD_, and seem to be somewhat
  684. * intertwined. This stuff came straight from the windows driver.
  685. ***/
  686. /* Turn AutoExposure off in VP and enable the serial bridge to the sensor */
  687. cpia2_do_command(cam, CPIA2_CMD_GET_VP_SYSTEM_CTRL, TRANSFER_READ, 0);
  688. tmp_reg = cam->params.vp_params.system_ctrl;
  689. cmd.buffer.registers[0].value = tmp_reg &
  690. (tmp_reg & (CPIA2_VP_SYSTEMCTRL_HK_CONTROL ^ 0xFF));
  691. cpia2_do_command(cam, CPIA2_CMD_GET_DEVICE_CONFIG, TRANSFER_READ, 0);
  692. cmd.buffer.registers[1].value = cam->params.vp_params.device_config |
  693. CPIA2_VP_DEVICE_CONFIG_SERIAL_BRIDGE;
  694. cmd.buffer.registers[0].index = CPIA2_VP_SYSTEMCTRL;
  695. cmd.buffer.registers[1].index = CPIA2_VP_DEVICE_CONFIG;
  696. cmd.req_mode = CAMERAACCESS_TYPE_RANDOM | CAMERAACCESS_VP;
  697. cmd.reg_count = 2;
  698. cmd.direction = TRANSFER_WRITE;
  699. cmd.start = 0;
  700. cpia2_send_command(cam, &cmd);
  701. /* Set the correct I2C address in the CPiA-2 system register */
  702. cpia2_do_command(cam,
  703. CPIA2_CMD_SET_SERIAL_ADDR,
  704. TRANSFER_WRITE,
  705. CPIA2_SYSTEM_VP_SERIAL_ADDR_SENSOR);
  706. /* Now have sensor access - set bit to turn the audio regulator off */
  707. cpia2_do_command(cam,
  708. CPIA2_CMD_SET_SENSOR_CR1,
  709. TRANSFER_WRITE, CPIA2_SENSOR_CR1_DOWN_AUDIO_REGULATOR);
  710. /* Set the correct I2C address in the CPiA-2 system register */
  711. if (cam->params.pnp_id.device_type == DEVICE_STV_672)
  712. cpia2_do_command(cam,
  713. CPIA2_CMD_SET_SERIAL_ADDR,
  714. TRANSFER_WRITE,
  715. CPIA2_SYSTEM_VP_SERIAL_ADDR_VP); // 0x88
  716. else
  717. cpia2_do_command(cam,
  718. CPIA2_CMD_SET_SERIAL_ADDR,
  719. TRANSFER_WRITE,
  720. CPIA2_SYSTEM_VP_SERIAL_ADDR_676_VP); // 0x8a
  721. /* increase signal drive strength */
  722. if (cam->params.pnp_id.device_type == DEVICE_STV_676)
  723. cpia2_do_command(cam,
  724. CPIA2_CMD_SET_VP_EXP_MODES,
  725. TRANSFER_WRITE,
  726. CPIA2_VP_EXPOSURE_MODES_COMPILE_EXP);
  727. /* Start autoexposure */
  728. cpia2_do_command(cam, CPIA2_CMD_GET_DEVICE_CONFIG, TRANSFER_READ, 0);
  729. cmd.buffer.registers[0].value = cam->params.vp_params.device_config &
  730. (CPIA2_VP_DEVICE_CONFIG_SERIAL_BRIDGE ^ 0xFF);
  731. cpia2_do_command(cam, CPIA2_CMD_GET_VP_SYSTEM_CTRL, TRANSFER_READ, 0);
  732. cmd.buffer.registers[1].value =
  733. cam->params.vp_params.system_ctrl | CPIA2_VP_SYSTEMCTRL_HK_CONTROL;
  734. cmd.buffer.registers[0].index = CPIA2_VP_DEVICE_CONFIG;
  735. cmd.buffer.registers[1].index = CPIA2_VP_SYSTEMCTRL;
  736. cmd.req_mode = CAMERAACCESS_TYPE_RANDOM | CAMERAACCESS_VP;
  737. cmd.reg_count = 2;
  738. cmd.direction = TRANSFER_WRITE;
  739. cpia2_send_command(cam, &cmd);
  740. /* Set compression state */
  741. cpia2_do_command(cam, CPIA2_CMD_GET_VC_CONTROL, TRANSFER_READ, 0);
  742. if (cam->params.compression.inhibit_htables) {
  743. tmp_reg = cam->params.vc_params.vc_control |
  744. CPIA2_VC_VC_CTRL_INHIBIT_H_TABLES;
  745. } else {
  746. tmp_reg = cam->params.vc_params.vc_control &
  747. ~CPIA2_VC_VC_CTRL_INHIBIT_H_TABLES;
  748. }
  749. cpia2_do_command(cam, CPIA2_CMD_SET_VC_CONTROL, TRANSFER_WRITE,tmp_reg);
  750. /* Set target size (kb) on vc
  751. This is a heuristic based on the quality parameter and the raw
  752. framesize in kB divided by 16 (the compression factor when the
  753. quality is 100%) */
  754. target_kb = (cam->width * cam->height * 2 / 16384) *
  755. cam->params.vc_params.quality / 100;
  756. if (target_kb < 1)
  757. target_kb = 1;
  758. cpia2_do_command(cam, CPIA2_CMD_SET_TARGET_KB,
  759. TRANSFER_WRITE, target_kb);
  760. /* Wiggle VC Reset */
  761. /***
  762. * First read and wait a bit.
  763. ***/
  764. for (i = 0; i < 50; i++) {
  765. cpia2_do_command(cam, CPIA2_CMD_GET_PW_CONTROL,
  766. TRANSFER_READ, 0);
  767. }
  768. tmp_reg = cam->params.vc_params.pw_control;
  769. tmp_reg &= ~CPIA2_VC_PW_CTRL_VC_RESET_N;
  770. cpia2_do_command(cam, CPIA2_CMD_SET_PW_CONTROL, TRANSFER_WRITE,tmp_reg);
  771. tmp_reg |= CPIA2_VC_PW_CTRL_VC_RESET_N;
  772. cpia2_do_command(cam, CPIA2_CMD_SET_PW_CONTROL, TRANSFER_WRITE,tmp_reg);
  773. cpia2_do_command(cam, CPIA2_CMD_SET_DEF_JPEG_OPT, TRANSFER_WRITE, 0);
  774. cpia2_do_command(cam, CPIA2_CMD_GET_USER_MODE, TRANSFER_READ, 0);
  775. DBG("After VC RESET, user mode is 0x%0X\n",
  776. cam->params.vp_params.video_mode);
  777. return retval;
  778. }
  779. /******************************************************************************
  780. *
  781. * cpia2_set_high_power
  782. *
  783. *****************************************************************************/
  784. static int cpia2_set_high_power(struct camera_data *cam)
  785. {
  786. int i;
  787. for (i = 0; i <= 50; i++) {
  788. /* Read system status */
  789. cpia2_do_command(cam,CPIA2_CMD_GET_SYSTEM_CTRL,TRANSFER_READ,0);
  790. /* If there is an error, clear it */
  791. if(cam->params.camera_state.system_ctrl &
  792. CPIA2_SYSTEM_CONTROL_V2W_ERR)
  793. cpia2_do_command(cam, CPIA2_CMD_CLEAR_V2W_ERR,
  794. TRANSFER_WRITE, 0);
  795. /* Try to set high power mode */
  796. cpia2_do_command(cam, CPIA2_CMD_SET_SYSTEM_CTRL,
  797. TRANSFER_WRITE, 1);
  798. /* Try to read something in VP to check if everything is awake */
  799. cpia2_do_command(cam, CPIA2_CMD_GET_VP_SYSTEM_STATE,
  800. TRANSFER_READ, 0);
  801. if (cam->params.vp_params.system_state &
  802. CPIA2_VP_SYSTEMSTATE_HK_ALIVE) {
  803. break;
  804. } else if (i == 50) {
  805. cam->params.camera_state.power_mode = LO_POWER_MODE;
  806. ERR("Camera did not wake up\n");
  807. return -EIO;
  808. }
  809. }
  810. DBG("System now in high power state\n");
  811. cam->params.camera_state.power_mode = HI_POWER_MODE;
  812. return 0;
  813. }
  814. /******************************************************************************
  815. *
  816. * cpia2_set_low_power
  817. *
  818. *****************************************************************************/
  819. int cpia2_set_low_power(struct camera_data *cam)
  820. {
  821. cam->params.camera_state.power_mode = LO_POWER_MODE;
  822. cpia2_do_command(cam, CPIA2_CMD_SET_SYSTEM_CTRL, TRANSFER_WRITE, 0);
  823. return 0;
  824. }
  825. /******************************************************************************
  826. *
  827. * apply_vp_patch
  828. *
  829. *****************************************************************************/
  830. static int cpia2_send_onebyte_command(struct camera_data *cam,
  831. struct cpia2_command *cmd,
  832. u8 start, u8 datum)
  833. {
  834. cmd->buffer.block_data[0] = datum;
  835. cmd->start = start;
  836. cmd->reg_count = 1;
  837. return cpia2_send_command(cam, cmd);
  838. }
  839. static int apply_vp_patch(struct camera_data *cam)
  840. {
  841. const struct firmware *fw;
  842. const char fw_name[] = FIRMWARE;
  843. int i, ret;
  844. struct cpia2_command cmd;
  845. ret = request_firmware(&fw, fw_name, &cam->dev->dev);
  846. if (ret) {
  847. printk(KERN_ERR "cpia2: failed to load VP patch \"%s\"\n",
  848. fw_name);
  849. return ret;
  850. }
  851. cmd.req_mode = CAMERAACCESS_TYPE_REPEAT | CAMERAACCESS_VP;
  852. cmd.direction = TRANSFER_WRITE;
  853. /* First send the start address... */
  854. cpia2_send_onebyte_command(cam, &cmd, 0x0A, fw->data[0]); /* hi */
  855. cpia2_send_onebyte_command(cam, &cmd, 0x0B, fw->data[1]); /* lo */
  856. /* ... followed by the data payload */
  857. for (i = 2; i < fw->size; i += 64) {
  858. cmd.start = 0x0C; /* Data */
  859. cmd.reg_count = min_t(uint, 64, fw->size - i);
  860. memcpy(cmd.buffer.block_data, &fw->data[i], cmd.reg_count);
  861. cpia2_send_command(cam, &cmd);
  862. }
  863. /* Next send the start address... */
  864. cpia2_send_onebyte_command(cam, &cmd, 0x0A, fw->data[0]); /* hi */
  865. cpia2_send_onebyte_command(cam, &cmd, 0x0B, fw->data[1]); /* lo */
  866. /* ... followed by the 'goto' command */
  867. cpia2_send_onebyte_command(cam, &cmd, 0x0D, 1);
  868. release_firmware(fw);
  869. return 0;
  870. }
  871. /******************************************************************************
  872. *
  873. * set_default_user_mode
  874. *
  875. *****************************************************************************/
  876. static int set_default_user_mode(struct camera_data *cam)
  877. {
  878. unsigned char user_mode;
  879. unsigned char frame_rate;
  880. int width = cam->params.roi.width;
  881. int height = cam->params.roi.height;
  882. switch (cam->params.version.sensor_flags) {
  883. case CPIA2_VP_SENSOR_FLAGS_404:
  884. case CPIA2_VP_SENSOR_FLAGS_407:
  885. case CPIA2_VP_SENSOR_FLAGS_409:
  886. case CPIA2_VP_SENSOR_FLAGS_410:
  887. if ((width > STV_IMAGE_QCIF_COLS)
  888. || (height > STV_IMAGE_QCIF_ROWS)) {
  889. user_mode = CPIA2_VP_USER_MODE_CIF;
  890. } else {
  891. user_mode = CPIA2_VP_USER_MODE_QCIFDS;
  892. }
  893. frame_rate = CPIA2_VP_FRAMERATE_30;
  894. break;
  895. case CPIA2_VP_SENSOR_FLAGS_500:
  896. if ((width > STV_IMAGE_CIF_COLS)
  897. || (height > STV_IMAGE_CIF_ROWS)) {
  898. user_mode = CPIA2_VP_USER_MODE_VGA;
  899. } else {
  900. user_mode = CPIA2_VP_USER_MODE_QVGADS;
  901. }
  902. if (cam->params.pnp_id.device_type == DEVICE_STV_672)
  903. frame_rate = CPIA2_VP_FRAMERATE_15;
  904. else
  905. frame_rate = CPIA2_VP_FRAMERATE_30;
  906. break;
  907. default:
  908. LOG("%s: Invalid sensor flag value 0x%0X\n",__func__,
  909. cam->params.version.sensor_flags);
  910. return -EINVAL;
  911. }
  912. DBG("Sensor flag = 0x%0x, user mode = 0x%0x, frame rate = 0x%X\n",
  913. cam->params.version.sensor_flags, user_mode, frame_rate);
  914. cpia2_do_command(cam, CPIA2_CMD_SET_USER_MODE, TRANSFER_WRITE,
  915. user_mode);
  916. if(cam->params.vp_params.frame_rate > 0 &&
  917. frame_rate > cam->params.vp_params.frame_rate)
  918. frame_rate = cam->params.vp_params.frame_rate;
  919. cpia2_set_fps(cam, frame_rate);
  920. // if (cam->params.pnp_id.device_type == DEVICE_STV_676)
  921. // cpia2_do_command(cam,
  922. // CPIA2_CMD_SET_VP_SYSTEM_CTRL,
  923. // TRANSFER_WRITE,
  924. // CPIA2_VP_SYSTEMCTRL_HK_CONTROL |
  925. // CPIA2_VP_SYSTEMCTRL_POWER_CONTROL);
  926. return 0;
  927. }
  928. /******************************************************************************
  929. *
  930. * cpia2_match_video_size
  931. *
  932. * return the best match, where 'best' is as always
  933. * the largest that is not bigger than what is requested.
  934. *****************************************************************************/
  935. int cpia2_match_video_size(int width, int height)
  936. {
  937. if (width >= STV_IMAGE_VGA_COLS && height >= STV_IMAGE_VGA_ROWS)
  938. return VIDEOSIZE_VGA;
  939. if (width >= STV_IMAGE_CIF_COLS && height >= STV_IMAGE_CIF_ROWS)
  940. return VIDEOSIZE_CIF;
  941. if (width >= STV_IMAGE_QVGA_COLS && height >= STV_IMAGE_QVGA_ROWS)
  942. return VIDEOSIZE_QVGA;
  943. if (width >= 288 && height >= 216)
  944. return VIDEOSIZE_288_216;
  945. if (width >= 256 && height >= 192)
  946. return VIDEOSIZE_256_192;
  947. if (width >= 224 && height >= 168)
  948. return VIDEOSIZE_224_168;
  949. if (width >= 192 && height >= 144)
  950. return VIDEOSIZE_192_144;
  951. if (width >= STV_IMAGE_QCIF_COLS && height >= STV_IMAGE_QCIF_ROWS)
  952. return VIDEOSIZE_QCIF;
  953. return -1;
  954. }
  955. /******************************************************************************
  956. *
  957. * SetVideoSize
  958. *
  959. *****************************************************************************/
  960. static int set_vw_size(struct camera_data *cam, int size)
  961. {
  962. int retval = 0;
  963. cam->params.vp_params.video_size = size;
  964. switch (size) {
  965. case VIDEOSIZE_VGA:
  966. DBG("Setting size to VGA\n");
  967. cam->params.roi.width = STV_IMAGE_VGA_COLS;
  968. cam->params.roi.height = STV_IMAGE_VGA_ROWS;
  969. cam->width = STV_IMAGE_VGA_COLS;
  970. cam->height = STV_IMAGE_VGA_ROWS;
  971. break;
  972. case VIDEOSIZE_CIF:
  973. DBG("Setting size to CIF\n");
  974. cam->params.roi.width = STV_IMAGE_CIF_COLS;
  975. cam->params.roi.height = STV_IMAGE_CIF_ROWS;
  976. cam->width = STV_IMAGE_CIF_COLS;
  977. cam->height = STV_IMAGE_CIF_ROWS;
  978. break;
  979. case VIDEOSIZE_QVGA:
  980. DBG("Setting size to QVGA\n");
  981. cam->params.roi.width = STV_IMAGE_QVGA_COLS;
  982. cam->params.roi.height = STV_IMAGE_QVGA_ROWS;
  983. cam->width = STV_IMAGE_QVGA_COLS;
  984. cam->height = STV_IMAGE_QVGA_ROWS;
  985. break;
  986. case VIDEOSIZE_288_216:
  987. cam->params.roi.width = 288;
  988. cam->params.roi.height = 216;
  989. cam->width = 288;
  990. cam->height = 216;
  991. break;
  992. case VIDEOSIZE_256_192:
  993. cam->width = 256;
  994. cam->height = 192;
  995. cam->params.roi.width = 256;
  996. cam->params.roi.height = 192;
  997. break;
  998. case VIDEOSIZE_224_168:
  999. cam->width = 224;
  1000. cam->height = 168;
  1001. cam->params.roi.width = 224;
  1002. cam->params.roi.height = 168;
  1003. break;
  1004. case VIDEOSIZE_192_144:
  1005. cam->width = 192;
  1006. cam->height = 144;
  1007. cam->params.roi.width = 192;
  1008. cam->params.roi.height = 144;
  1009. break;
  1010. case VIDEOSIZE_QCIF:
  1011. DBG("Setting size to QCIF\n");
  1012. cam->params.roi.width = STV_IMAGE_QCIF_COLS;
  1013. cam->params.roi.height = STV_IMAGE_QCIF_ROWS;
  1014. cam->width = STV_IMAGE_QCIF_COLS;
  1015. cam->height = STV_IMAGE_QCIF_ROWS;
  1016. break;
  1017. default:
  1018. retval = -EINVAL;
  1019. }
  1020. return retval;
  1021. }
  1022. /******************************************************************************
  1023. *
  1024. * configure_sensor
  1025. *
  1026. *****************************************************************************/
  1027. static int configure_sensor(struct camera_data *cam,
  1028. int req_width, int req_height)
  1029. {
  1030. int retval;
  1031. switch (cam->params.version.sensor_flags) {
  1032. case CPIA2_VP_SENSOR_FLAGS_404:
  1033. case CPIA2_VP_SENSOR_FLAGS_407:
  1034. case CPIA2_VP_SENSOR_FLAGS_409:
  1035. case CPIA2_VP_SENSOR_FLAGS_410:
  1036. retval = config_sensor_410(cam, req_width, req_height);
  1037. break;
  1038. case CPIA2_VP_SENSOR_FLAGS_500:
  1039. retval = config_sensor_500(cam, req_width, req_height);
  1040. break;
  1041. default:
  1042. return -EINVAL;
  1043. }
  1044. return retval;
  1045. }
  1046. /******************************************************************************
  1047. *
  1048. * config_sensor_410
  1049. *
  1050. *****************************************************************************/
  1051. static int config_sensor_410(struct camera_data *cam,
  1052. int req_width, int req_height)
  1053. {
  1054. struct cpia2_command cmd;
  1055. int i = 0;
  1056. int image_size;
  1057. int image_type;
  1058. int width = req_width;
  1059. int height = req_height;
  1060. /***
  1061. * Make sure size doesn't exceed CIF.
  1062. ***/
  1063. if (width > STV_IMAGE_CIF_COLS)
  1064. width = STV_IMAGE_CIF_COLS;
  1065. if (height > STV_IMAGE_CIF_ROWS)
  1066. height = STV_IMAGE_CIF_ROWS;
  1067. image_size = cpia2_match_video_size(width, height);
  1068. DBG("Config 410: width = %d, height = %d\n", width, height);
  1069. DBG("Image size returned is %d\n", image_size);
  1070. if (image_size >= 0) {
  1071. set_vw_size(cam, image_size);
  1072. width = cam->params.roi.width;
  1073. height = cam->params.roi.height;
  1074. DBG("After set_vw_size(), width = %d, height = %d\n",
  1075. width, height);
  1076. if (width <= 176 && height <= 144) {
  1077. DBG("image type = VIDEOSIZE_QCIF\n");
  1078. image_type = VIDEOSIZE_QCIF;
  1079. }
  1080. else if (width <= 320 && height <= 240) {
  1081. DBG("image type = VIDEOSIZE_QVGA\n");
  1082. image_type = VIDEOSIZE_QVGA;
  1083. }
  1084. else {
  1085. DBG("image type = VIDEOSIZE_CIF\n");
  1086. image_type = VIDEOSIZE_CIF;
  1087. }
  1088. } else {
  1089. ERR("ConfigSensor410 failed\n");
  1090. return -EINVAL;
  1091. }
  1092. cmd.req_mode = CAMERAACCESS_TYPE_RANDOM | CAMERAACCESS_VC;
  1093. cmd.direction = TRANSFER_WRITE;
  1094. /* VC Format */
  1095. cmd.buffer.registers[i].index = CPIA2_VC_VC_FORMAT;
  1096. if (image_type == VIDEOSIZE_CIF) {
  1097. cmd.buffer.registers[i++].value =
  1098. (u8) (CPIA2_VC_VC_FORMAT_UFIRST |
  1099. CPIA2_VC_VC_FORMAT_SHORTLINE);
  1100. } else {
  1101. cmd.buffer.registers[i++].value =
  1102. (u8) CPIA2_VC_VC_FORMAT_UFIRST;
  1103. }
  1104. /* VC Clocks */
  1105. cmd.buffer.registers[i].index = CPIA2_VC_VC_CLOCKS;
  1106. if (image_type == VIDEOSIZE_QCIF) {
  1107. if (cam->params.pnp_id.device_type == DEVICE_STV_672) {
  1108. cmd.buffer.registers[i++].value=
  1109. (u8)(CPIA2_VC_VC_672_CLOCKS_CIF_DIV_BY_3 |
  1110. CPIA2_VC_VC_672_CLOCKS_SCALING |
  1111. CPIA2_VC_VC_CLOCKS_LOGDIV2);
  1112. DBG("VC_Clocks (0xc4) should be B\n");
  1113. }
  1114. else {
  1115. cmd.buffer.registers[i++].value=
  1116. (u8)(CPIA2_VC_VC_676_CLOCKS_CIF_DIV_BY_3 |
  1117. CPIA2_VC_VC_CLOCKS_LOGDIV2);
  1118. }
  1119. } else {
  1120. if (cam->params.pnp_id.device_type == DEVICE_STV_672) {
  1121. cmd.buffer.registers[i++].value =
  1122. (u8) (CPIA2_VC_VC_672_CLOCKS_CIF_DIV_BY_3 |
  1123. CPIA2_VC_VC_CLOCKS_LOGDIV0);
  1124. }
  1125. else {
  1126. cmd.buffer.registers[i++].value =
  1127. (u8) (CPIA2_VC_VC_676_CLOCKS_CIF_DIV_BY_3 |
  1128. CPIA2_VC_VC_676_CLOCKS_SCALING |
  1129. CPIA2_VC_VC_CLOCKS_LOGDIV0);
  1130. }
  1131. }
  1132. DBG("VC_Clocks (0xc4) = 0x%0X\n", cmd.buffer.registers[i-1].value);
  1133. /* Input reqWidth from VC */
  1134. cmd.buffer.registers[i].index = CPIA2_VC_VC_IHSIZE_LO;
  1135. if (image_type == VIDEOSIZE_QCIF)
  1136. cmd.buffer.registers[i++].value =
  1137. (u8) (STV_IMAGE_QCIF_COLS / 4);
  1138. else
  1139. cmd.buffer.registers[i++].value =
  1140. (u8) (STV_IMAGE_CIF_COLS / 4);
  1141. /* Timings */
  1142. cmd.buffer.registers[i].index = CPIA2_VC_VC_XLIM_HI;
  1143. if (image_type == VIDEOSIZE_QCIF)
  1144. cmd.buffer.registers[i++].value = (u8) 0;
  1145. else
  1146. cmd.buffer.registers[i++].value = (u8) 1;
  1147. cmd.buffer.registers[i].index = CPIA2_VC_VC_XLIM_LO;
  1148. if (image_type == VIDEOSIZE_QCIF)
  1149. cmd.buffer.registers[i++].value = (u8) 208;
  1150. else
  1151. cmd.buffer.registers[i++].value = (u8) 160;
  1152. cmd.buffer.registers[i].index = CPIA2_VC_VC_YLIM_HI;
  1153. if (image_type == VIDEOSIZE_QCIF)
  1154. cmd.buffer.registers[i++].value = (u8) 0;
  1155. else
  1156. cmd.buffer.registers[i++].value = (u8) 1;
  1157. cmd.buffer.registers[i].index = CPIA2_VC_VC_YLIM_LO;
  1158. if (image_type == VIDEOSIZE_QCIF)
  1159. cmd.buffer.registers[i++].value = (u8) 160;
  1160. else
  1161. cmd.buffer.registers[i++].value = (u8) 64;
  1162. /* Output Image Size */
  1163. cmd.buffer.registers[i].index = CPIA2_VC_VC_OHSIZE;
  1164. cmd.buffer.registers[i++].value = cam->params.roi.width / 4;
  1165. cmd.buffer.registers[i].index = CPIA2_VC_VC_OVSIZE;
  1166. cmd.buffer.registers[i++].value = cam->params.roi.height / 4;
  1167. /* Cropping */
  1168. cmd.buffer.registers[i].index = CPIA2_VC_VC_HCROP;
  1169. if (image_type == VIDEOSIZE_QCIF)
  1170. cmd.buffer.registers[i++].value =
  1171. (u8) (((STV_IMAGE_QCIF_COLS / 4) - (width / 4)) / 2);
  1172. else
  1173. cmd.buffer.registers[i++].value =
  1174. (u8) (((STV_IMAGE_CIF_COLS / 4) - (width / 4)) / 2);
  1175. cmd.buffer.registers[i].index = CPIA2_VC_VC_VCROP;
  1176. if (image_type == VIDEOSIZE_QCIF)
  1177. cmd.buffer.registers[i++].value =
  1178. (u8) (((STV_IMAGE_QCIF_ROWS / 4) - (height / 4)) / 2);
  1179. else
  1180. cmd.buffer.registers[i++].value =
  1181. (u8) (((STV_IMAGE_CIF_ROWS / 4) - (height / 4)) / 2);
  1182. /* Scaling registers (defaults) */
  1183. cmd.buffer.registers[i].index = CPIA2_VC_VC_HPHASE;
  1184. cmd.buffer.registers[i++].value = (u8) 0;
  1185. cmd.buffer.registers[i].index = CPIA2_VC_VC_VPHASE;
  1186. cmd.buffer.registers[i++].value = (u8) 0;
  1187. cmd.buffer.registers[i].index = CPIA2_VC_VC_HISPAN;
  1188. cmd.buffer.registers[i++].value = (u8) 31;
  1189. cmd.buffer.registers[i].index = CPIA2_VC_VC_VISPAN;
  1190. cmd.buffer.registers[i++].value = (u8) 31;
  1191. cmd.buffer.registers[i].index = CPIA2_VC_VC_HICROP;
  1192. cmd.buffer.registers[i++].value = (u8) 0;
  1193. cmd.buffer.registers[i].index = CPIA2_VC_VC_VICROP;
  1194. cmd.buffer.registers[i++].value = (u8) 0;
  1195. cmd.buffer.registers[i].index = CPIA2_VC_VC_HFRACT;
  1196. cmd.buffer.registers[i++].value = (u8) 0x81; /* = 8/1 = 8 (HIBYTE/LOBYTE) */
  1197. cmd.buffer.registers[i].index = CPIA2_VC_VC_VFRACT;
  1198. cmd.buffer.registers[i++].value = (u8) 0x81; /* = 8/1 = 8 (HIBYTE/LOBYTE) */
  1199. cmd.reg_count = i;
  1200. cpia2_send_command(cam, &cmd);
  1201. return i;
  1202. }
  1203. /******************************************************************************
  1204. *
  1205. * config_sensor_500(cam)
  1206. *
  1207. *****************************************************************************/
  1208. static int config_sensor_500(struct camera_data *cam,
  1209. int req_width, int req_height)
  1210. {
  1211. struct cpia2_command cmd;
  1212. int i = 0;
  1213. int image_size = VIDEOSIZE_CIF;
  1214. int image_type = VIDEOSIZE_VGA;
  1215. int width = req_width;
  1216. int height = req_height;
  1217. unsigned int device = cam->params.pnp_id.device_type;
  1218. image_size = cpia2_match_video_size(width, height);
  1219. if (width > STV_IMAGE_CIF_COLS || height > STV_IMAGE_CIF_ROWS)
  1220. image_type = VIDEOSIZE_VGA;
  1221. else if (width > STV_IMAGE_QVGA_COLS || height > STV_IMAGE_QVGA_ROWS)
  1222. image_type = VIDEOSIZE_CIF;
  1223. else if (width > STV_IMAGE_QCIF_COLS || height > STV_IMAGE_QCIF_ROWS)
  1224. image_type = VIDEOSIZE_QVGA;
  1225. else
  1226. image_type = VIDEOSIZE_QCIF;
  1227. if (image_size >= 0) {
  1228. set_vw_size(cam, image_size);
  1229. width = cam->params.roi.width;
  1230. height = cam->params.roi.height;
  1231. } else {
  1232. ERR("ConfigSensor500 failed\n");
  1233. return -EINVAL;
  1234. }
  1235. DBG("image_size = %d, width = %d, height = %d, type = %d\n",
  1236. image_size, width, height, image_type);
  1237. cmd.req_mode = CAMERAACCESS_TYPE_RANDOM | CAMERAACCESS_VC;
  1238. cmd.direction = TRANSFER_WRITE;
  1239. i = 0;
  1240. /* VC Format */
  1241. cmd.buffer.registers[i].index = CPIA2_VC_VC_FORMAT;
  1242. cmd.buffer.registers[i].value = (u8) CPIA2_VC_VC_FORMAT_UFIRST;
  1243. if (image_type == VIDEOSIZE_QCIF)
  1244. cmd.buffer.registers[i].value |= (u8) CPIA2_VC_VC_FORMAT_DECIMATING;
  1245. i++;
  1246. /* VC Clocks */
  1247. cmd.buffer.registers[i].index = CPIA2_VC_VC_CLOCKS;
  1248. if (device == DEVICE_STV_672) {
  1249. if (image_type == VIDEOSIZE_VGA)
  1250. cmd.buffer.registers[i].value =
  1251. (u8)CPIA2_VC_VC_CLOCKS_LOGDIV1;
  1252. else
  1253. cmd.buffer.registers[i].value =
  1254. (u8)(CPIA2_VC_VC_672_CLOCKS_SCALING |
  1255. CPIA2_VC_VC_CLOCKS_LOGDIV3);
  1256. } else {
  1257. if (image_type == VIDEOSIZE_VGA)
  1258. cmd.buffer.registers[i].value =
  1259. (u8)CPIA2_VC_VC_CLOCKS_LOGDIV0;
  1260. else
  1261. cmd.buffer.registers[i].value =
  1262. (u8)(CPIA2_VC_VC_676_CLOCKS_SCALING |
  1263. CPIA2_VC_VC_CLOCKS_LOGDIV2);
  1264. }
  1265. i++;
  1266. DBG("VC_CLOCKS = 0x%X\n", cmd.buffer.registers[i-1].value);
  1267. /* Input width from VP */
  1268. cmd.buffer.registers[i].index = CPIA2_VC_VC_IHSIZE_LO;
  1269. if (image_type == VIDEOSIZE_VGA)
  1270. cmd.buffer.registers[i].value =
  1271. (u8) (STV_IMAGE_VGA_COLS / 4);
  1272. else
  1273. cmd.buffer.registers[i].value =
  1274. (u8) (STV_IMAGE_QVGA_COLS / 4);
  1275. i++;
  1276. DBG("Input width = %d\n", cmd.buffer.registers[i-1].value);
  1277. /* Timings */
  1278. cmd.buffer.registers[i].index = CPIA2_VC_VC_XLIM_HI;
  1279. if (image_type == VIDEOSIZE_VGA)
  1280. cmd.buffer.registers[i++].value = (u8) 2;
  1281. else
  1282. cmd.buffer.registers[i++].value = (u8) 1;
  1283. cmd.buffer.registers[i].index = CPIA2_VC_VC_XLIM_LO;
  1284. if (image_type == VIDEOSIZE_VGA)
  1285. cmd.buffer.registers[i++].value = (u8) 250;
  1286. else if (image_type == VIDEOSIZE_QVGA)
  1287. cmd.buffer.registers[i++].value = (u8) 125;
  1288. else
  1289. cmd.buffer.registers[i++].value = (u8) 160;
  1290. cmd.buffer.registers[i].index = CPIA2_VC_VC_YLIM_HI;
  1291. if (image_type == VIDEOSIZE_VGA)
  1292. cmd.buffer.registers[i++].value = (u8) 2;
  1293. else
  1294. cmd.buffer.registers[i++].value = (u8) 1;
  1295. cmd.buffer.registers[i].index = CPIA2_VC_VC_YLIM_LO;
  1296. if (image_type == VIDEOSIZE_VGA)
  1297. cmd.buffer.registers[i++].value = (u8) 12;
  1298. else if (image_type == VIDEOSIZE_QVGA)
  1299. cmd.buffer.registers[i++].value = (u8) 64;
  1300. else
  1301. cmd.buffer.registers[i++].value = (u8) 6;
  1302. /* Output Image Size */
  1303. cmd.buffer.registers[i].index = CPIA2_VC_VC_OHSIZE;
  1304. if (image_type == VIDEOSIZE_QCIF)
  1305. cmd.buffer.registers[i++].value = STV_IMAGE_CIF_COLS / 4;
  1306. else
  1307. cmd.buffer.registers[i++].value = width / 4;
  1308. cmd.buffer.registers[i].index = CPIA2_VC_VC_OVSIZE;
  1309. if (image_type == VIDEOSIZE_QCIF)
  1310. cmd.buffer.registers[i++].value = STV_IMAGE_CIF_ROWS / 4;
  1311. else
  1312. cmd.buffer.registers[i++].value = height / 4;
  1313. /* Cropping */
  1314. cmd.buffer.registers[i].index = CPIA2_VC_VC_HCROP;
  1315. if (image_type == VIDEOSIZE_VGA)
  1316. cmd.buffer.registers[i++].value =
  1317. (u8) (((STV_IMAGE_VGA_COLS / 4) - (width / 4)) / 2);
  1318. else if (image_type == VIDEOSIZE_QVGA)
  1319. cmd.buffer.registers[i++].value =
  1320. (u8) (((STV_IMAGE_QVGA_COLS / 4) - (width / 4)) / 2);
  1321. else if (image_type == VIDEOSIZE_CIF)
  1322. cmd.buffer.registers[i++].value =
  1323. (u8) (((STV_IMAGE_CIF_COLS / 4) - (width / 4)) / 2);
  1324. else /*if (image_type == VIDEOSIZE_QCIF)*/
  1325. cmd.buffer.registers[i++].value =
  1326. (u8) (((STV_IMAGE_QCIF_COLS / 4) - (width / 4)) / 2);
  1327. cmd.buffer.registers[i].index = CPIA2_VC_VC_VCROP;
  1328. if (image_type == VIDEOSIZE_VGA)
  1329. cmd.buffer.registers[i++].value =
  1330. (u8) (((STV_IMAGE_VGA_ROWS / 4) - (height / 4)) / 2);
  1331. else if (image_type == VIDEOSIZE_QVGA)
  1332. cmd.buffer.registers[i++].value =
  1333. (u8) (((STV_IMAGE_QVGA_ROWS / 4) - (height / 4)) / 2);
  1334. else if (image_type == VIDEOSIZE_CIF)
  1335. cmd.buffer.registers[i++].value =
  1336. (u8) (((STV_IMAGE_CIF_ROWS / 4) - (height / 4)) / 2);
  1337. else /*if (image_type == VIDEOSIZE_QCIF)*/
  1338. cmd.buffer.registers[i++].value =
  1339. (u8) (((STV_IMAGE_QCIF_ROWS / 4) - (height / 4)) / 2);
  1340. /* Scaling registers (defaults) */
  1341. cmd.buffer.registers[i].index = CPIA2_VC_VC_HPHASE;
  1342. if (image_type == VIDEOSIZE_CIF || image_type == VIDEOSIZE_QCIF)
  1343. cmd.buffer.registers[i++].value = (u8) 36;
  1344. else
  1345. cmd.buffer.registers[i++].value = (u8) 0;
  1346. cmd.buffer.registers[i].index = CPIA2_VC_VC_VPHASE;
  1347. if (image_type == VIDEOSIZE_CIF || image_type == VIDEOSIZE_QCIF)
  1348. cmd.buffer.registers[i++].value = (u8) 32;
  1349. else
  1350. cmd.buffer.registers[i++].value = (u8) 0;
  1351. cmd.buffer.registers[i].index = CPIA2_VC_VC_HISPAN;
  1352. if (image_type == VIDEOSIZE_CIF || image_type == VIDEOSIZE_QCIF)
  1353. cmd.buffer.registers[i++].value = (u8) 26;
  1354. else
  1355. cmd.buffer.registers[i++].value = (u8) 31;
  1356. cmd.buffer.registers[i].index = CPIA2_VC_VC_VISPAN;
  1357. if (image_type == VIDEOSIZE_CIF || image_type == VIDEOSIZE_QCIF)
  1358. cmd.buffer.registers[i++].value = (u8) 21;
  1359. else
  1360. cmd.buffer.registers[i++].value = (u8) 31;
  1361. cmd.buffer.registers[i].index = CPIA2_VC_VC_HICROP;
  1362. cmd.buffer.registers[i++].value = (u8) 0;
  1363. cmd.buffer.registers[i].index = CPIA2_VC_VC_VICROP;
  1364. cmd.buffer.registers[i++].value = (u8) 0;
  1365. cmd.buffer.registers[i].index = CPIA2_VC_VC_HFRACT;
  1366. if (image_type == VIDEOSIZE_CIF || image_type == VIDEOSIZE_QCIF)
  1367. cmd.buffer.registers[i++].value = (u8) 0x2B; /* 2/11 */
  1368. else
  1369. cmd.buffer.registers[i++].value = (u8) 0x81; /* 8/1 */
  1370. cmd.buffer.registers[i].index = CPIA2_VC_VC_VFRACT;
  1371. if (image_type == VIDEOSIZE_CIF || image_type == VIDEOSIZE_QCIF)
  1372. cmd.buffer.registers[i++].value = (u8) 0x13; /* 1/3 */
  1373. else
  1374. cmd.buffer.registers[i++].value = (u8) 0x81; /* 8/1 */
  1375. cmd.reg_count = i;
  1376. cpia2_send_command(cam, &cmd);
  1377. return i;
  1378. }
  1379. /******************************************************************************
  1380. *
  1381. * setallproperties
  1382. *
  1383. * This sets all user changeable properties to the values in cam->params.
  1384. *****************************************************************************/
  1385. static int set_all_properties(struct camera_data *cam)
  1386. {
  1387. /**
  1388. * Don't set target_kb here, it will be set later.
  1389. * framerate and user_mode were already set (set_default_user_mode).
  1390. **/
  1391. cpia2_usb_change_streaming_alternate(cam,
  1392. cam->params.camera_state.stream_mode);
  1393. cpia2_do_command(cam,
  1394. CPIA2_CMD_SET_VC_MP_GPIO_DIRECTION,
  1395. TRANSFER_WRITE, cam->params.vp_params.gpio_direction);
  1396. cpia2_do_command(cam, CPIA2_CMD_SET_VC_MP_GPIO_DATA, TRANSFER_WRITE,
  1397. cam->params.vp_params.gpio_data);
  1398. v4l2_ctrl_handler_setup(&cam->hdl);
  1399. wake_system(cam);
  1400. set_lowlight_boost(cam);
  1401. return 0;
  1402. }
  1403. /******************************************************************************
  1404. *
  1405. * cpia2_save_camera_state
  1406. *
  1407. *****************************************************************************/
  1408. void cpia2_save_camera_state(struct camera_data *cam)
  1409. {
  1410. cpia2_do_command(cam, CPIA2_CMD_GET_USER_EFFECTS, TRANSFER_READ, 0);
  1411. cpia2_do_command(cam, CPIA2_CMD_GET_VC_MP_GPIO_DIRECTION, TRANSFER_READ,
  1412. 0);
  1413. cpia2_do_command(cam, CPIA2_CMD_GET_VC_MP_GPIO_DATA, TRANSFER_READ, 0);
  1414. /* Don't get framerate or target_kb. Trust the values we already have */
  1415. }
  1416. /******************************************************************************
  1417. *
  1418. * cpia2_set_flicker_mode
  1419. *
  1420. *****************************************************************************/
  1421. int cpia2_set_flicker_mode(struct camera_data *cam, int mode)
  1422. {
  1423. unsigned char cam_reg;
  1424. int err = 0;
  1425. if(cam->params.pnp_id.device_type != DEVICE_STV_672)
  1426. return -EINVAL;
  1427. /* Set the appropriate bits in FLICKER_MODES, preserving the rest */
  1428. if((err = cpia2_do_command(cam, CPIA2_CMD_GET_FLICKER_MODES,
  1429. TRANSFER_READ, 0)))
  1430. return err;
  1431. cam_reg = cam->params.flicker_control.cam_register;
  1432. switch(mode) {
  1433. case NEVER_FLICKER:
  1434. cam_reg |= CPIA2_VP_FLICKER_MODES_NEVER_FLICKER;
  1435. cam_reg &= ~CPIA2_VP_FLICKER_MODES_50HZ;
  1436. break;
  1437. case FLICKER_60:
  1438. cam_reg &= ~CPIA2_VP_FLICKER_MODES_NEVER_FLICKER;
  1439. cam_reg &= ~CPIA2_VP_FLICKER_MODES_50HZ;
  1440. break;
  1441. case FLICKER_50:
  1442. cam_reg &= ~CPIA2_VP_FLICKER_MODES_NEVER_FLICKER;
  1443. cam_reg |= CPIA2_VP_FLICKER_MODES_50HZ;
  1444. break;
  1445. default:
  1446. return -EINVAL;
  1447. }
  1448. if((err = cpia2_do_command(cam, CPIA2_CMD_SET_FLICKER_MODES,
  1449. TRANSFER_WRITE, cam_reg)))
  1450. return err;
  1451. /* Set the appropriate bits in EXP_MODES, preserving the rest */
  1452. if((err = cpia2_do_command(cam, CPIA2_CMD_GET_VP_EXP_MODES,
  1453. TRANSFER_READ, 0)))
  1454. return err;
  1455. cam_reg = cam->params.vp_params.exposure_modes;
  1456. if (mode == NEVER_FLICKER) {
  1457. cam_reg |= CPIA2_VP_EXPOSURE_MODES_INHIBIT_FLICKER;
  1458. } else {
  1459. cam_reg &= ~CPIA2_VP_EXPOSURE_MODES_INHIBIT_FLICKER;
  1460. }
  1461. if((err = cpia2_do_command(cam, CPIA2_CMD_SET_VP_EXP_MODES,
  1462. TRANSFER_WRITE, cam_reg)))
  1463. return err;
  1464. if((err = cpia2_do_command(cam, CPIA2_CMD_REHASH_VP4,
  1465. TRANSFER_WRITE, 1)))
  1466. return err;
  1467. switch(mode) {
  1468. case NEVER_FLICKER:
  1469. case FLICKER_60:
  1470. case FLICKER_50:
  1471. cam->params.flicker_control.flicker_mode_req = mode;
  1472. break;
  1473. default:
  1474. err = -EINVAL;
  1475. }
  1476. return err;
  1477. }
  1478. /******************************************************************************
  1479. *
  1480. * cpia2_set_property_flip
  1481. *
  1482. *****************************************************************************/
  1483. void cpia2_set_property_flip(struct camera_data *cam, int prop_val)
  1484. {
  1485. unsigned char cam_reg;
  1486. cpia2_do_command(cam, CPIA2_CMD_GET_USER_EFFECTS, TRANSFER_READ, 0);
  1487. cam_reg = cam->params.vp_params.user_effects;
  1488. if (prop_val)
  1489. {
  1490. cam_reg |= CPIA2_VP_USER_EFFECTS_FLIP;
  1491. }
  1492. else
  1493. {
  1494. cam_reg &= ~CPIA2_VP_USER_EFFECTS_FLIP;
  1495. }
  1496. cam->params.vp_params.user_effects = cam_reg;
  1497. cpia2_do_command(cam, CPIA2_CMD_SET_USER_EFFECTS, TRANSFER_WRITE,
  1498. cam_reg);
  1499. }
  1500. /******************************************************************************
  1501. *
  1502. * cpia2_set_property_mirror
  1503. *
  1504. *****************************************************************************/
  1505. void cpia2_set_property_mirror(struct camera_data *cam, int prop_val)
  1506. {
  1507. unsigned char cam_reg;
  1508. cpia2_do_command(cam, CPIA2_CMD_GET_USER_EFFECTS, TRANSFER_READ, 0);
  1509. cam_reg = cam->params.vp_params.user_effects;
  1510. if (prop_val)
  1511. {
  1512. cam_reg |= CPIA2_VP_USER_EFFECTS_MIRROR;
  1513. }
  1514. else
  1515. {
  1516. cam_reg &= ~CPIA2_VP_USER_EFFECTS_MIRROR;
  1517. }
  1518. cam->params.vp_params.user_effects = cam_reg;
  1519. cpia2_do_command(cam, CPIA2_CMD_SET_USER_EFFECTS, TRANSFER_WRITE,
  1520. cam_reg);
  1521. }
  1522. /******************************************************************************
  1523. *
  1524. * cpia2_set_gpio
  1525. *
  1526. *****************************************************************************/
  1527. int cpia2_set_gpio(struct camera_data *cam, unsigned char setting)
  1528. {
  1529. int ret;
  1530. /* Set the microport direction (register 0x90, should be defined
  1531. * already) to 1 (user output), and set the microport data (0x91) to
  1532. * the value in the ioctl argument.
  1533. */
  1534. ret = cpia2_do_command(cam,
  1535. CPIA2_CMD_SET_VC_MP_GPIO_DIRECTION,
  1536. CPIA2_VC_MP_DIR_OUTPUT,
  1537. 255);
  1538. if (ret < 0)
  1539. return ret;
  1540. cam->params.vp_params.gpio_direction = 255;
  1541. ret = cpia2_do_command(cam,
  1542. CPIA2_CMD_SET_VC_MP_GPIO_DATA,
  1543. CPIA2_VC_MP_DIR_OUTPUT,
  1544. setting);
  1545. if (ret < 0)
  1546. return ret;
  1547. cam->params.vp_params.gpio_data = setting;
  1548. return 0;
  1549. }
  1550. /******************************************************************************
  1551. *
  1552. * cpia2_set_fps
  1553. *
  1554. *****************************************************************************/
  1555. int cpia2_set_fps(struct camera_data *cam, int framerate)
  1556. {
  1557. int retval;
  1558. switch(framerate) {
  1559. case CPIA2_VP_FRAMERATE_30:
  1560. case CPIA2_VP_FRAMERATE_25:
  1561. if(cam->params.pnp_id.device_type == DEVICE_STV_672 &&
  1562. cam->params.version.sensor_flags ==
  1563. CPIA2_VP_SENSOR_FLAGS_500) {
  1564. return -EINVAL;
  1565. }
  1566. /* Fall through */
  1567. case CPIA2_VP_FRAMERATE_15:
  1568. case CPIA2_VP_FRAMERATE_12_5:
  1569. case CPIA2_VP_FRAMERATE_7_5:
  1570. case CPIA2_VP_FRAMERATE_6_25:
  1571. break;
  1572. default:
  1573. return -EINVAL;
  1574. }
  1575. if (cam->params.pnp_id.device_type == DEVICE_STV_672 &&
  1576. framerate == CPIA2_VP_FRAMERATE_15)
  1577. framerate = 0; /* Work around bug in VP4 */
  1578. retval = cpia2_do_command(cam,
  1579. CPIA2_CMD_FRAMERATE_REQ,
  1580. TRANSFER_WRITE,
  1581. framerate);
  1582. if(retval == 0)
  1583. cam->params.vp_params.frame_rate = framerate;
  1584. return retval;
  1585. }
  1586. /******************************************************************************
  1587. *
  1588. * cpia2_set_brightness
  1589. *
  1590. *****************************************************************************/
  1591. void cpia2_set_brightness(struct camera_data *cam, unsigned char value)
  1592. {
  1593. /***
  1594. * Don't let the register be set to zero - bug in VP4 - flash of full
  1595. * brightness
  1596. ***/
  1597. if (cam->params.pnp_id.device_type == DEVICE_STV_672 && value == 0)
  1598. value++;
  1599. DBG("Setting brightness to %d (0x%0x)\n", value, value);
  1600. cpia2_do_command(cam, CPIA2_CMD_SET_VP_BRIGHTNESS, TRANSFER_WRITE, value);
  1601. }
  1602. /******************************************************************************
  1603. *
  1604. * cpia2_set_contrast
  1605. *
  1606. *****************************************************************************/
  1607. void cpia2_set_contrast(struct camera_data *cam, unsigned char value)
  1608. {
  1609. DBG("Setting contrast to %d (0x%0x)\n", value, value);
  1610. cpia2_do_command(cam, CPIA2_CMD_SET_CONTRAST, TRANSFER_WRITE, value);
  1611. }
  1612. /******************************************************************************
  1613. *
  1614. * cpia2_set_saturation
  1615. *
  1616. *****************************************************************************/
  1617. void cpia2_set_saturation(struct camera_data *cam, unsigned char value)
  1618. {
  1619. DBG("Setting saturation to %d (0x%0x)\n", value, value);
  1620. cpia2_do_command(cam,CPIA2_CMD_SET_VP_SATURATION, TRANSFER_WRITE,value);
  1621. }
  1622. /******************************************************************************
  1623. *
  1624. * wake_system
  1625. *
  1626. *****************************************************************************/
  1627. static void wake_system(struct camera_data *cam)
  1628. {
  1629. cpia2_do_command(cam, CPIA2_CMD_SET_WAKEUP, TRANSFER_WRITE, 0);
  1630. }
  1631. /******************************************************************************
  1632. *
  1633. * set_lowlight_boost
  1634. *
  1635. * Valid for STV500 sensor only
  1636. *****************************************************************************/
  1637. static void set_lowlight_boost(struct camera_data *cam)
  1638. {
  1639. struct cpia2_command cmd;
  1640. if (cam->params.pnp_id.device_type != DEVICE_STV_672 ||
  1641. cam->params.version.sensor_flags != CPIA2_VP_SENSOR_FLAGS_500)
  1642. return;
  1643. cmd.direction = TRANSFER_WRITE;
  1644. cmd.req_mode = CAMERAACCESS_TYPE_BLOCK | CAMERAACCESS_VP;
  1645. cmd.reg_count = 3;
  1646. cmd.start = CPIA2_VP_RAM_ADDR_H;
  1647. cmd.buffer.block_data[0] = 0; /* High byte of address to write to */
  1648. cmd.buffer.block_data[1] = 0x59; /* Low byte of address to write to */
  1649. cmd.buffer.block_data[2] = 0; /* High byte of data to write */
  1650. cpia2_send_command(cam, &cmd);
  1651. if (cam->params.vp_params.lowlight_boost) {
  1652. cmd.buffer.block_data[0] = 0x02; /* Low byte data to write */
  1653. } else {
  1654. cmd.buffer.block_data[0] = 0x06;
  1655. }
  1656. cmd.start = CPIA2_VP_RAM_DATA;
  1657. cmd.reg_count = 1;
  1658. cpia2_send_command(cam, &cmd);
  1659. /* Rehash the VP4 values */
  1660. cpia2_do_command(cam, CPIA2_CMD_REHASH_VP4, TRANSFER_WRITE, 1);
  1661. }
  1662. /******************************************************************************
  1663. *
  1664. * cpia2_set_format
  1665. *
  1666. * Assumes that new size is already set in param struct.
  1667. *****************************************************************************/
  1668. void cpia2_set_format(struct camera_data *cam)
  1669. {
  1670. cam->flush = true;
  1671. cpia2_usb_stream_pause(cam);
  1672. /* reset camera to new size */
  1673. cpia2_set_low_power(cam);
  1674. cpia2_reset_camera(cam);
  1675. cam->flush = false;
  1676. cpia2_dbg_dump_registers(cam);
  1677. cpia2_usb_stream_resume(cam);
  1678. }
  1679. /******************************************************************************
  1680. *
  1681. * cpia2_dbg_dump_registers
  1682. *
  1683. *****************************************************************************/
  1684. void cpia2_dbg_dump_registers(struct camera_data *cam)
  1685. {
  1686. #ifdef _CPIA2_DEBUG_
  1687. struct cpia2_command cmd;
  1688. if (!(debugs_on & DEBUG_DUMP_REGS))
  1689. return;
  1690. cmd.direction = TRANSFER_READ;
  1691. /* Start with bank 0 (SYSTEM) */
  1692. cmd.req_mode = CAMERAACCESS_TYPE_BLOCK | CAMERAACCESS_SYSTEM;
  1693. cmd.reg_count = 3;
  1694. cmd.start = 0;
  1695. cpia2_send_command(cam, &cmd);
  1696. printk(KERN_DEBUG "System Device Hi = 0x%X\n",
  1697. cmd.buffer.block_data[0]);
  1698. printk(KERN_DEBUG "System Device Lo = 0x%X\n",
  1699. cmd.buffer.block_data[1]);
  1700. printk(KERN_DEBUG "System_system control = 0x%X\n",
  1701. cmd.buffer.block_data[2]);
  1702. /* Bank 1 (VC) */
  1703. cmd.req_mode = CAMERAACCESS_TYPE_BLOCK | CAMERAACCESS_VC;
  1704. cmd.reg_count = 4;
  1705. cmd.start = 0x80;
  1706. cpia2_send_command(cam, &cmd);
  1707. printk(KERN_DEBUG "ASIC_ID = 0x%X\n",
  1708. cmd.buffer.block_data[0]);
  1709. printk(KERN_DEBUG "ASIC_REV = 0x%X\n",
  1710. cmd.buffer.block_data[1]);
  1711. printk(KERN_DEBUG "PW_CONTRL = 0x%X\n",
  1712. cmd.buffer.block_data[2]);
  1713. printk(KERN_DEBUG "WAKEUP = 0x%X\n",
  1714. cmd.buffer.block_data[3]);
  1715. cmd.start = 0xA0; /* ST_CTRL */
  1716. cmd.reg_count = 1;
  1717. cpia2_send_command(cam, &cmd);
  1718. printk(KERN_DEBUG "Stream ctrl = 0x%X\n",
  1719. cmd.buffer.block_data[0]);
  1720. cmd.start = 0xA4; /* Stream status */
  1721. cpia2_send_command(cam, &cmd);
  1722. printk(KERN_DEBUG "Stream status = 0x%X\n",
  1723. cmd.buffer.block_data[0]);
  1724. cmd.start = 0xA8; /* USB status */
  1725. cmd.reg_count = 3;
  1726. cpia2_send_command(cam, &cmd);
  1727. printk(KERN_DEBUG "USB_CTRL = 0x%X\n",
  1728. cmd.buffer.block_data[0]);
  1729. printk(KERN_DEBUG "USB_STRM = 0x%X\n",
  1730. cmd.buffer.block_data[1]);
  1731. printk(KERN_DEBUG "USB_STATUS = 0x%X\n",
  1732. cmd.buffer.block_data[2]);
  1733. cmd.start = 0xAF; /* USB settings */
  1734. cmd.reg_count = 1;
  1735. cpia2_send_command(cam, &cmd);
  1736. printk(KERN_DEBUG "USB settings = 0x%X\n",
  1737. cmd.buffer.block_data[0]);
  1738. cmd.start = 0xC0; /* VC stuff */
  1739. cmd.reg_count = 26;
  1740. cpia2_send_command(cam, &cmd);
  1741. printk(KERN_DEBUG "VC Control = 0x%0X\n",
  1742. cmd.buffer.block_data[0]);
  1743. printk(KERN_DEBUG "VC Format = 0x%0X\n",
  1744. cmd.buffer.block_data[3]);
  1745. printk(KERN_DEBUG "VC Clocks = 0x%0X\n",
  1746. cmd.buffer.block_data[4]);
  1747. printk(KERN_DEBUG "VC IHSize = 0x%0X\n",
  1748. cmd.buffer.block_data[5]);
  1749. printk(KERN_DEBUG "VC Xlim Hi = 0x%0X\n",
  1750. cmd.buffer.block_data[6]);
  1751. printk(KERN_DEBUG "VC XLim Lo = 0x%0X\n",
  1752. cmd.buffer.block_data[7]);
  1753. printk(KERN_DEBUG "VC YLim Hi = 0x%0X\n",
  1754. cmd.buffer.block_data[8]);
  1755. printk(KERN_DEBUG "VC YLim Lo = 0x%0X\n",
  1756. cmd.buffer.block_data[9]);
  1757. printk(KERN_DEBUG "VC OHSize = 0x%0X\n",
  1758. cmd.buffer.block_data[10]);
  1759. printk(KERN_DEBUG "VC OVSize = 0x%0X\n",
  1760. cmd.buffer.block_data[11]);
  1761. printk(KERN_DEBUG "VC HCrop = 0x%0X\n",
  1762. cmd.buffer.block_data[12]);
  1763. printk(KERN_DEBUG "VC VCrop = 0x%0X\n",
  1764. cmd.buffer.block_data[13]);
  1765. printk(KERN_DEBUG "VC HPhase = 0x%0X\n",
  1766. cmd.buffer.block_data[14]);
  1767. printk(KERN_DEBUG "VC VPhase = 0x%0X\n",
  1768. cmd.buffer.block_data[15]);
  1769. printk(KERN_DEBUG "VC HIspan = 0x%0X\n",
  1770. cmd.buffer.block_data[16]);
  1771. printk(KERN_DEBUG "VC VIspan = 0x%0X\n",
  1772. cmd.buffer.block_data[17]);
  1773. printk(KERN_DEBUG "VC HiCrop = 0x%0X\n",
  1774. cmd.buffer.block_data[18]);
  1775. printk(KERN_DEBUG "VC ViCrop = 0x%0X\n",
  1776. cmd.buffer.block_data[19]);
  1777. printk(KERN_DEBUG "VC HiFract = 0x%0X\n",
  1778. cmd.buffer.block_data[20]);
  1779. printk(KERN_DEBUG "VC ViFract = 0x%0X\n",
  1780. cmd.buffer.block_data[21]);
  1781. printk(KERN_DEBUG "VC JPeg Opt = 0x%0X\n",
  1782. cmd.buffer.block_data[22]);
  1783. printk(KERN_DEBUG "VC Creep Per = 0x%0X\n",
  1784. cmd.buffer.block_data[23]);
  1785. printk(KERN_DEBUG "VC User Sq. = 0x%0X\n",
  1786. cmd.buffer.block_data[24]);
  1787. printk(KERN_DEBUG "VC Target KB = 0x%0X\n",
  1788. cmd.buffer.block_data[25]);
  1789. /*** VP ***/
  1790. cmd.req_mode = CAMERAACCESS_TYPE_BLOCK | CAMERAACCESS_VP;
  1791. cmd.reg_count = 14;
  1792. cmd.start = 0;
  1793. cpia2_send_command(cam, &cmd);
  1794. printk(KERN_DEBUG "VP Dev Hi = 0x%0X\n",
  1795. cmd.buffer.block_data[0]);
  1796. printk(KERN_DEBUG "VP Dev Lo = 0x%0X\n",
  1797. cmd.buffer.block_data[1]);
  1798. printk(KERN_DEBUG "VP Sys State = 0x%0X\n",
  1799. cmd.buffer.block_data[2]);
  1800. printk(KERN_DEBUG "VP Sys Ctrl = 0x%0X\n",
  1801. cmd.buffer.block_data[3]);
  1802. printk(KERN_DEBUG "VP Sensor flg = 0x%0X\n",
  1803. cmd.buffer.block_data[5]);
  1804. printk(KERN_DEBUG "VP Sensor Rev = 0x%0X\n",
  1805. cmd.buffer.block_data[6]);
  1806. printk(KERN_DEBUG "VP Dev Config = 0x%0X\n",
  1807. cmd.buffer.block_data[7]);
  1808. printk(KERN_DEBUG "VP GPIO_DIR = 0x%0X\n",
  1809. cmd.buffer.block_data[8]);
  1810. printk(KERN_DEBUG "VP GPIO_DATA = 0x%0X\n",
  1811. cmd.buffer.block_data[9]);
  1812. printk(KERN_DEBUG "VP Ram ADDR H = 0x%0X\n",
  1813. cmd.buffer.block_data[10]);
  1814. printk(KERN_DEBUG "VP Ram ADDR L = 0x%0X\n",
  1815. cmd.buffer.block_data[11]);
  1816. printk(KERN_DEBUG "VP RAM Data = 0x%0X\n",
  1817. cmd.buffer.block_data[12]);
  1818. printk(KERN_DEBUG "Do Call = 0x%0X\n",
  1819. cmd.buffer.block_data[13]);
  1820. if (cam->params.pnp_id.device_type == DEVICE_STV_672) {
  1821. cmd.reg_count = 9;
  1822. cmd.start = 0x0E;
  1823. cpia2_send_command(cam, &cmd);
  1824. printk(KERN_DEBUG "VP Clock Ctrl = 0x%0X\n",
  1825. cmd.buffer.block_data[0]);
  1826. printk(KERN_DEBUG "VP Patch Rev = 0x%0X\n",
  1827. cmd.buffer.block_data[1]);
  1828. printk(KERN_DEBUG "VP Vid Mode = 0x%0X\n",
  1829. cmd.buffer.block_data[2]);
  1830. printk(KERN_DEBUG "VP Framerate = 0x%0X\n",
  1831. cmd.buffer.block_data[3]);
  1832. printk(KERN_DEBUG "VP UserEffect = 0x%0X\n",
  1833. cmd.buffer.block_data[4]);
  1834. printk(KERN_DEBUG "VP White Bal = 0x%0X\n",
  1835. cmd.buffer.block_data[5]);
  1836. printk(KERN_DEBUG "VP WB thresh = 0x%0X\n",
  1837. cmd.buffer.block_data[6]);
  1838. printk(KERN_DEBUG "VP Exp Modes = 0x%0X\n",
  1839. cmd.buffer.block_data[7]);
  1840. printk(KERN_DEBUG "VP Exp Target = 0x%0X\n",
  1841. cmd.buffer.block_data[8]);
  1842. cmd.reg_count = 1;
  1843. cmd.start = 0x1B;
  1844. cpia2_send_command(cam, &cmd);
  1845. printk(KERN_DEBUG "VP FlickerMds = 0x%0X\n",
  1846. cmd.buffer.block_data[0]);
  1847. } else {
  1848. cmd.reg_count = 8 ;
  1849. cmd.start = 0x0E;
  1850. cpia2_send_command(cam, &cmd);
  1851. printk(KERN_DEBUG "VP Clock Ctrl = 0x%0X\n",
  1852. cmd.buffer.block_data[0]);
  1853. printk(KERN_DEBUG "VP Patch Rev = 0x%0X\n",
  1854. cmd.buffer.block_data[1]);
  1855. printk(KERN_DEBUG "VP Vid Mode = 0x%0X\n",
  1856. cmd.buffer.block_data[5]);
  1857. printk(KERN_DEBUG "VP Framerate = 0x%0X\n",
  1858. cmd.buffer.block_data[6]);
  1859. printk(KERN_DEBUG "VP UserEffect = 0x%0X\n",
  1860. cmd.buffer.block_data[7]);
  1861. cmd.reg_count = 1;
  1862. cmd.start = CPIA2_VP5_EXPOSURE_TARGET;
  1863. cpia2_send_command(cam, &cmd);
  1864. printk(KERN_DEBUG "VP5 Exp Target= 0x%0X\n",
  1865. cmd.buffer.block_data[0]);
  1866. cmd.reg_count = 4;
  1867. cmd.start = 0x3A;
  1868. cpia2_send_command(cam, &cmd);
  1869. printk(KERN_DEBUG "VP5 MY Black = 0x%0X\n",
  1870. cmd.buffer.block_data[0]);
  1871. printk(KERN_DEBUG "VP5 MCY Range = 0x%0X\n",
  1872. cmd.buffer.block_data[1]);
  1873. printk(KERN_DEBUG "VP5 MYCEILING = 0x%0X\n",
  1874. cmd.buffer.block_data[2]);
  1875. printk(KERN_DEBUG "VP5 MCUV Sat = 0x%0X\n",
  1876. cmd.buffer.block_data[3]);
  1877. }
  1878. #endif
  1879. }
  1880. /******************************************************************************
  1881. *
  1882. * reset_camera_struct
  1883. *
  1884. * Sets all values to the defaults
  1885. *****************************************************************************/
  1886. static void reset_camera_struct(struct camera_data *cam)
  1887. {
  1888. /***
  1889. * The following parameter values are the defaults from the register map.
  1890. ***/
  1891. cam->params.vp_params.lowlight_boost = 0;
  1892. /* FlickerModes */
  1893. cam->params.flicker_control.flicker_mode_req = NEVER_FLICKER;
  1894. /* jpeg params */
  1895. cam->params.compression.jpeg_options = CPIA2_VC_VC_JPEG_OPT_DEFAULT;
  1896. cam->params.compression.creep_period = 2;
  1897. cam->params.compression.user_squeeze = 20;
  1898. cam->params.compression.inhibit_htables = false;
  1899. /* gpio params */
  1900. cam->params.vp_params.gpio_direction = 0; /* write, the default safe mode */
  1901. cam->params.vp_params.gpio_data = 0;
  1902. /* Target kb params */
  1903. cam->params.vc_params.quality = 100;
  1904. /***
  1905. * Set Sensor FPS as fast as possible.
  1906. ***/
  1907. if(cam->params.pnp_id.device_type == DEVICE_STV_672) {
  1908. if(cam->params.version.sensor_flags == CPIA2_VP_SENSOR_FLAGS_500)
  1909. cam->params.vp_params.frame_rate = CPIA2_VP_FRAMERATE_15;
  1910. else
  1911. cam->params.vp_params.frame_rate = CPIA2_VP_FRAMERATE_30;
  1912. } else {
  1913. cam->params.vp_params.frame_rate = CPIA2_VP_FRAMERATE_30;
  1914. }
  1915. /***
  1916. * Set default video mode as large as possible :
  1917. * for vga sensor set to vga, for cif sensor set to CIF.
  1918. ***/
  1919. if (cam->params.version.sensor_flags == CPIA2_VP_SENSOR_FLAGS_500) {
  1920. cam->sensor_type = CPIA2_SENSOR_500;
  1921. cam->video_size = VIDEOSIZE_VGA;
  1922. cam->params.roi.width = STV_IMAGE_VGA_COLS;
  1923. cam->params.roi.height = STV_IMAGE_VGA_ROWS;
  1924. } else {
  1925. cam->sensor_type = CPIA2_SENSOR_410;
  1926. cam->video_size = VIDEOSIZE_CIF;
  1927. cam->params.roi.width = STV_IMAGE_CIF_COLS;
  1928. cam->params.roi.height = STV_IMAGE_CIF_ROWS;
  1929. }
  1930. cam->width = cam->params.roi.width;
  1931. cam->height = cam->params.roi.height;
  1932. }
  1933. /******************************************************************************
  1934. *
  1935. * cpia2_init_camera_struct
  1936. *
  1937. * Initializes camera struct, does not call reset to fill in defaults.
  1938. *****************************************************************************/
  1939. struct camera_data *cpia2_init_camera_struct(struct usb_interface *intf)
  1940. {
  1941. struct camera_data *cam;
  1942. cam = kzalloc(sizeof(*cam), GFP_KERNEL);
  1943. if (!cam) {
  1944. ERR("couldn't kmalloc cpia2 struct\n");
  1945. return NULL;
  1946. }
  1947. cam->v4l2_dev.release = cpia2_camera_release;
  1948. if (v4l2_device_register(&intf->dev, &cam->v4l2_dev) < 0) {
  1949. v4l2_err(&cam->v4l2_dev, "couldn't register v4l2_device\n");
  1950. kfree(cam);
  1951. return NULL;
  1952. }
  1953. mutex_init(&cam->v4l2_lock);
  1954. init_waitqueue_head(&cam->wq_stream);
  1955. return cam;
  1956. }
  1957. /******************************************************************************
  1958. *
  1959. * cpia2_init_camera
  1960. *
  1961. * Initializes camera.
  1962. *****************************************************************************/
  1963. int cpia2_init_camera(struct camera_data *cam)
  1964. {
  1965. DBG("Start\n");
  1966. cam->mmapped = false;
  1967. /* Get sensor and asic types before reset. */
  1968. cpia2_set_high_power(cam);
  1969. cpia2_get_version_info(cam);
  1970. if (cam->params.version.asic_id != CPIA2_ASIC_672) {
  1971. ERR("Device IO error (asicID has incorrect value of 0x%X\n",
  1972. cam->params.version.asic_id);
  1973. return -ENODEV;
  1974. }
  1975. /* Set GPIO direction and data to a safe state. */
  1976. cpia2_do_command(cam, CPIA2_CMD_SET_VC_MP_GPIO_DIRECTION,
  1977. TRANSFER_WRITE, 0);
  1978. cpia2_do_command(cam, CPIA2_CMD_SET_VC_MP_GPIO_DATA,
  1979. TRANSFER_WRITE, 0);
  1980. /* resetting struct requires version info for sensor and asic types */
  1981. reset_camera_struct(cam);
  1982. cpia2_set_low_power(cam);
  1983. DBG("End\n");
  1984. return 0;
  1985. }
  1986. /******************************************************************************
  1987. *
  1988. * cpia2_allocate_buffers
  1989. *
  1990. *****************************************************************************/
  1991. int cpia2_allocate_buffers(struct camera_data *cam)
  1992. {
  1993. int i;
  1994. if(!cam->buffers) {
  1995. u32 size = cam->num_frames*sizeof(struct framebuf);
  1996. cam->buffers = kmalloc(size, GFP_KERNEL);
  1997. if(!cam->buffers) {
  1998. ERR("couldn't kmalloc frame buffer structures\n");
  1999. return -ENOMEM;
  2000. }
  2001. }
  2002. if(!cam->frame_buffer) {
  2003. cam->frame_buffer = rvmalloc(cam->frame_size*cam->num_frames);
  2004. if (!cam->frame_buffer) {
  2005. ERR("couldn't vmalloc frame buffer data area\n");
  2006. kfree(cam->buffers);
  2007. cam->buffers = NULL;
  2008. return -ENOMEM;
  2009. }
  2010. }
  2011. for(i=0; i<cam->num_frames-1; ++i) {
  2012. cam->buffers[i].next = &cam->buffers[i+1];
  2013. cam->buffers[i].data = cam->frame_buffer +i*cam->frame_size;
  2014. cam->buffers[i].status = FRAME_EMPTY;
  2015. cam->buffers[i].length = 0;
  2016. cam->buffers[i].max_length = 0;
  2017. cam->buffers[i].num = i;
  2018. }
  2019. cam->buffers[i].next = cam->buffers;
  2020. cam->buffers[i].data = cam->frame_buffer +i*cam->frame_size;
  2021. cam->buffers[i].status = FRAME_EMPTY;
  2022. cam->buffers[i].length = 0;
  2023. cam->buffers[i].max_length = 0;
  2024. cam->buffers[i].num = i;
  2025. cam->curbuff = cam->buffers;
  2026. cam->workbuff = cam->curbuff->next;
  2027. DBG("buffers=%p, curbuff=%p, workbuff=%p\n", cam->buffers, cam->curbuff,
  2028. cam->workbuff);
  2029. return 0;
  2030. }
  2031. /******************************************************************************
  2032. *
  2033. * cpia2_free_buffers
  2034. *
  2035. *****************************************************************************/
  2036. void cpia2_free_buffers(struct camera_data *cam)
  2037. {
  2038. if(cam->buffers) {
  2039. kfree(cam->buffers);
  2040. cam->buffers = NULL;
  2041. }
  2042. if(cam->frame_buffer) {
  2043. rvfree(cam->frame_buffer, cam->frame_size*cam->num_frames);
  2044. cam->frame_buffer = NULL;
  2045. }
  2046. }
  2047. /******************************************************************************
  2048. *
  2049. * cpia2_read
  2050. *
  2051. *****************************************************************************/
  2052. long cpia2_read(struct camera_data *cam,
  2053. char __user *buf, unsigned long count, int noblock)
  2054. {
  2055. struct framebuf *frame;
  2056. if (!count)
  2057. return 0;
  2058. if (!buf) {
  2059. ERR("%s: buffer NULL\n",__func__);
  2060. return -EINVAL;
  2061. }
  2062. if (!cam) {
  2063. ERR("%s: Internal error, camera_data NULL!\n",__func__);
  2064. return -EINVAL;
  2065. }
  2066. if (!cam->streaming) {
  2067. /* Start streaming */
  2068. cpia2_usb_stream_start(cam,
  2069. cam->params.camera_state.stream_mode);
  2070. }
  2071. /* Copy cam->curbuff in case it changes while we're processing */
  2072. frame = cam->curbuff;
  2073. if (noblock && frame->status != FRAME_READY) {
  2074. return -EAGAIN;
  2075. }
  2076. if (frame->status != FRAME_READY) {
  2077. mutex_unlock(&cam->v4l2_lock);
  2078. wait_event_interruptible(cam->wq_stream,
  2079. !video_is_registered(&cam->vdev) ||
  2080. (frame = cam->curbuff)->status == FRAME_READY);
  2081. mutex_lock(&cam->v4l2_lock);
  2082. if (signal_pending(current))
  2083. return -ERESTARTSYS;
  2084. if (!video_is_registered(&cam->vdev))
  2085. return 0;
  2086. }
  2087. /* copy data to user space */
  2088. if (frame->length > count)
  2089. return -EFAULT;
  2090. if (copy_to_user(buf, frame->data, frame->length))
  2091. return -EFAULT;
  2092. count = frame->length;
  2093. frame->status = FRAME_EMPTY;
  2094. return count;
  2095. }
  2096. /******************************************************************************
  2097. *
  2098. * cpia2_poll
  2099. *
  2100. *****************************************************************************/
  2101. __poll_t cpia2_poll(struct camera_data *cam, struct file *filp,
  2102. poll_table *wait)
  2103. {
  2104. __poll_t status = v4l2_ctrl_poll(filp, wait);
  2105. if ((poll_requested_events(wait) & (EPOLLIN | EPOLLRDNORM)) &&
  2106. !cam->streaming) {
  2107. /* Start streaming */
  2108. cpia2_usb_stream_start(cam,
  2109. cam->params.camera_state.stream_mode);
  2110. }
  2111. poll_wait(filp, &cam->wq_stream, wait);
  2112. if (cam->curbuff->status == FRAME_READY)
  2113. status |= EPOLLIN | EPOLLRDNORM;
  2114. return status;
  2115. }
  2116. /******************************************************************************
  2117. *
  2118. * cpia2_remap_buffer
  2119. *
  2120. *****************************************************************************/
  2121. int cpia2_remap_buffer(struct camera_data *cam, struct vm_area_struct *vma)
  2122. {
  2123. const char *adr = (const char *)vma->vm_start;
  2124. unsigned long size = vma->vm_end-vma->vm_start;
  2125. unsigned long start_offset = vma->vm_pgoff << PAGE_SHIFT;
  2126. unsigned long start = (unsigned long) adr;
  2127. unsigned long page, pos;
  2128. DBG("mmap offset:%ld size:%ld\n", start_offset, size);
  2129. if (!video_is_registered(&cam->vdev))
  2130. return -ENODEV;
  2131. if (size > cam->frame_size*cam->num_frames ||
  2132. (start_offset % cam->frame_size) != 0 ||
  2133. (start_offset+size > cam->frame_size*cam->num_frames))
  2134. return -EINVAL;
  2135. pos = ((unsigned long) (cam->frame_buffer)) + start_offset;
  2136. while (size > 0) {
  2137. page = kvirt_to_pa(pos);
  2138. if (remap_pfn_range(vma, start, page >> PAGE_SHIFT, PAGE_SIZE, PAGE_SHARED))
  2139. return -EAGAIN;
  2140. start += PAGE_SIZE;
  2141. pos += PAGE_SIZE;
  2142. if (size > PAGE_SIZE)
  2143. size -= PAGE_SIZE;
  2144. else
  2145. size = 0;
  2146. }
  2147. cam->mmapped = true;
  2148. return 0;
  2149. }