tm6000-stds.c 23 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633
  1. /*
  2. * tm6000-stds.c - driver for TM5600/TM6000/TM6010 USB video capture devices
  3. *
  4. * Copyright (C) 2007 Mauro Carvalho Chehab
  5. *
  6. * This program is free software; you can redistribute it and/or modify
  7. * it under the terms of the GNU General Public License as published by
  8. * the Free Software Foundation version 2
  9. *
  10. * This program is distributed in the hope that it will be useful,
  11. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  12. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  13. * GNU General Public License for more details.
  14. */
  15. #include <linux/module.h>
  16. #include <linux/kernel.h>
  17. #include "tm6000.h"
  18. #include "tm6000-regs.h"
  19. static unsigned int tm6010_a_mode;
  20. module_param(tm6010_a_mode, int, 0644);
  21. MODULE_PARM_DESC(tm6010_a_mode, "set tm6010 sif audio mode");
  22. struct tm6000_reg_settings {
  23. unsigned char req;
  24. unsigned char reg;
  25. unsigned char value;
  26. };
  27. struct tm6000_std_settings {
  28. v4l2_std_id id;
  29. struct tm6000_reg_settings *common;
  30. };
  31. static struct tm6000_reg_settings composite_pal_m[] = {
  32. { TM6010_REQ07_R3F_RESET, 0x01 },
  33. { TM6010_REQ07_R00_VIDEO_CONTROL0, 0x04 },
  34. { TM6010_REQ07_R01_VIDEO_CONTROL1, 0x0e },
  35. { TM6010_REQ07_R02_VIDEO_CONTROL2, 0x5f },
  36. { TM6010_REQ07_R03_YC_SEP_CONTROL, 0x00 },
  37. { TM6010_REQ07_R07_OUTPUT_CONTROL, 0x31 },
  38. { TM6010_REQ07_R18_CHROMA_DTO_INCREMENT3, 0x1e },
  39. { TM6010_REQ07_R19_CHROMA_DTO_INCREMENT2, 0x83 },
  40. { TM6010_REQ07_R1A_CHROMA_DTO_INCREMENT1, 0x0a },
  41. { TM6010_REQ07_R1B_CHROMA_DTO_INCREMENT0, 0xe0 },
  42. { TM6010_REQ07_R1C_HSYNC_DTO_INCREMENT3, 0x1c },
  43. { TM6010_REQ07_R1D_HSYNC_DTO_INCREMENT2, 0xcc },
  44. { TM6010_REQ07_R1E_HSYNC_DTO_INCREMENT1, 0xcc },
  45. { TM6010_REQ07_R1F_HSYNC_DTO_INCREMENT0, 0xcd },
  46. { TM6010_REQ07_R2E_ACTIVE_VIDEO_HSTART, 0x88 },
  47. { TM6010_REQ07_R30_ACTIVE_VIDEO_VSTART, 0x20 },
  48. { TM6010_REQ07_R31_ACTIVE_VIDEO_VHIGHT, 0x61 },
  49. { TM6010_REQ07_R33_VSYNC_HLOCK_MAX, 0x0c },
  50. { TM6010_REQ07_R35_VSYNC_AGC_MAX, 0x1c },
  51. { TM6010_REQ07_R82_COMB_FILTER_CONFIG, 0x52 },
  52. { TM6010_REQ07_R83_CHROMA_LOCK_CONFIG, 0x6f },
  53. { TM6010_REQ07_R04_LUMA_HAGC_CONTROL, 0xdc },
  54. { TM6010_REQ07_R0D_CHROMA_KILL_LEVEL, 0x07 },
  55. { TM6010_REQ07_R3F_RESET, 0x00 },
  56. { 0, 0, 0 }
  57. };
  58. static struct tm6000_reg_settings composite_pal_nc[] = {
  59. { TM6010_REQ07_R3F_RESET, 0x01 },
  60. { TM6010_REQ07_R00_VIDEO_CONTROL0, 0x36 },
  61. { TM6010_REQ07_R01_VIDEO_CONTROL1, 0x0e },
  62. { TM6010_REQ07_R02_VIDEO_CONTROL2, 0x5f },
  63. { TM6010_REQ07_R03_YC_SEP_CONTROL, 0x02 },
  64. { TM6010_REQ07_R07_OUTPUT_CONTROL, 0x31 },
  65. { TM6010_REQ07_R18_CHROMA_DTO_INCREMENT3, 0x1e },
  66. { TM6010_REQ07_R19_CHROMA_DTO_INCREMENT2, 0x91 },
  67. { TM6010_REQ07_R1A_CHROMA_DTO_INCREMENT1, 0x1f },
  68. { TM6010_REQ07_R1B_CHROMA_DTO_INCREMENT0, 0x0c },
  69. { TM6010_REQ07_R1C_HSYNC_DTO_INCREMENT3, 0x1c },
  70. { TM6010_REQ07_R1D_HSYNC_DTO_INCREMENT2, 0xcc },
  71. { TM6010_REQ07_R1E_HSYNC_DTO_INCREMENT1, 0xcc },
  72. { TM6010_REQ07_R1F_HSYNC_DTO_INCREMENT0, 0xcd },
  73. { TM6010_REQ07_R2E_ACTIVE_VIDEO_HSTART, 0x8c },
  74. { TM6010_REQ07_R30_ACTIVE_VIDEO_VSTART, 0x2c },
  75. { TM6010_REQ07_R31_ACTIVE_VIDEO_VHIGHT, 0xc1 },
  76. { TM6010_REQ07_R33_VSYNC_HLOCK_MAX, 0x0c },
  77. { TM6010_REQ07_R35_VSYNC_AGC_MAX, 0x1c },
  78. { TM6010_REQ07_R82_COMB_FILTER_CONFIG, 0x52 },
  79. { TM6010_REQ07_R83_CHROMA_LOCK_CONFIG, 0x6f },
  80. { TM6010_REQ07_R04_LUMA_HAGC_CONTROL, 0xdc },
  81. { TM6010_REQ07_R0D_CHROMA_KILL_LEVEL, 0x07 },
  82. { TM6010_REQ07_R3F_RESET, 0x00 },
  83. { 0, 0, 0 }
  84. };
  85. static struct tm6000_reg_settings composite_pal[] = {
  86. { TM6010_REQ07_R3F_RESET, 0x01 },
  87. { TM6010_REQ07_R00_VIDEO_CONTROL0, 0x32 },
  88. { TM6010_REQ07_R01_VIDEO_CONTROL1, 0x0e },
  89. { TM6010_REQ07_R02_VIDEO_CONTROL2, 0x5f },
  90. { TM6010_REQ07_R03_YC_SEP_CONTROL, 0x02 },
  91. { TM6010_REQ07_R07_OUTPUT_CONTROL, 0x31 },
  92. { TM6010_REQ07_R18_CHROMA_DTO_INCREMENT3, 0x25 },
  93. { TM6010_REQ07_R19_CHROMA_DTO_INCREMENT2, 0xd5 },
  94. { TM6010_REQ07_R1A_CHROMA_DTO_INCREMENT1, 0x63 },
  95. { TM6010_REQ07_R1B_CHROMA_DTO_INCREMENT0, 0x50 },
  96. { TM6010_REQ07_R1C_HSYNC_DTO_INCREMENT3, 0x1c },
  97. { TM6010_REQ07_R1D_HSYNC_DTO_INCREMENT2, 0xcc },
  98. { TM6010_REQ07_R1E_HSYNC_DTO_INCREMENT1, 0xcc },
  99. { TM6010_REQ07_R1F_HSYNC_DTO_INCREMENT0, 0xcd },
  100. { TM6010_REQ07_R2E_ACTIVE_VIDEO_HSTART, 0x8c },
  101. { TM6010_REQ07_R30_ACTIVE_VIDEO_VSTART, 0x2c },
  102. { TM6010_REQ07_R31_ACTIVE_VIDEO_VHIGHT, 0xc1 },
  103. { TM6010_REQ07_R33_VSYNC_HLOCK_MAX, 0x0c },
  104. { TM6010_REQ07_R35_VSYNC_AGC_MAX, 0x1c },
  105. { TM6010_REQ07_R82_COMB_FILTER_CONFIG, 0x52 },
  106. { TM6010_REQ07_R83_CHROMA_LOCK_CONFIG, 0x6f },
  107. { TM6010_REQ07_R04_LUMA_HAGC_CONTROL, 0xdc },
  108. { TM6010_REQ07_R0D_CHROMA_KILL_LEVEL, 0x07 },
  109. { TM6010_REQ07_R3F_RESET, 0x00 },
  110. { 0, 0, 0 }
  111. };
  112. static struct tm6000_reg_settings composite_secam[] = {
  113. { TM6010_REQ07_R3F_RESET, 0x01 },
  114. { TM6010_REQ07_R00_VIDEO_CONTROL0, 0x38 },
  115. { TM6010_REQ07_R01_VIDEO_CONTROL1, 0x0e },
  116. { TM6010_REQ07_R02_VIDEO_CONTROL2, 0x5f },
  117. { TM6010_REQ07_R03_YC_SEP_CONTROL, 0x02 },
  118. { TM6010_REQ07_R07_OUTPUT_CONTROL, 0x31 },
  119. { TM6010_REQ07_R18_CHROMA_DTO_INCREMENT3, 0x24 },
  120. { TM6010_REQ07_R19_CHROMA_DTO_INCREMENT2, 0x92 },
  121. { TM6010_REQ07_R1A_CHROMA_DTO_INCREMENT1, 0xe8 },
  122. { TM6010_REQ07_R1B_CHROMA_DTO_INCREMENT0, 0xed },
  123. { TM6010_REQ07_R1C_HSYNC_DTO_INCREMENT3, 0x1c },
  124. { TM6010_REQ07_R1D_HSYNC_DTO_INCREMENT2, 0xcc },
  125. { TM6010_REQ07_R1E_HSYNC_DTO_INCREMENT1, 0xcc },
  126. { TM6010_REQ07_R1F_HSYNC_DTO_INCREMENT0, 0xcd },
  127. { TM6010_REQ07_R2E_ACTIVE_VIDEO_HSTART, 0x8c },
  128. { TM6010_REQ07_R30_ACTIVE_VIDEO_VSTART, 0x2c },
  129. { TM6010_REQ07_R31_ACTIVE_VIDEO_VHIGHT, 0xc1 },
  130. { TM6010_REQ07_R33_VSYNC_HLOCK_MAX, 0x2c },
  131. { TM6010_REQ07_R35_VSYNC_AGC_MAX, 0x18 },
  132. { TM6010_REQ07_R82_COMB_FILTER_CONFIG, 0x42 },
  133. { TM6010_REQ07_R83_CHROMA_LOCK_CONFIG, 0xff },
  134. { TM6010_REQ07_R0D_CHROMA_KILL_LEVEL, 0x07 },
  135. { TM6010_REQ07_R3F_RESET, 0x00 },
  136. { 0, 0, 0 }
  137. };
  138. static struct tm6000_reg_settings composite_ntsc[] = {
  139. { TM6010_REQ07_R3F_RESET, 0x01 },
  140. { TM6010_REQ07_R00_VIDEO_CONTROL0, 0x00 },
  141. { TM6010_REQ07_R01_VIDEO_CONTROL1, 0x0f },
  142. { TM6010_REQ07_R02_VIDEO_CONTROL2, 0x5f },
  143. { TM6010_REQ07_R03_YC_SEP_CONTROL, 0x00 },
  144. { TM6010_REQ07_R07_OUTPUT_CONTROL, 0x31 },
  145. { TM6010_REQ07_R18_CHROMA_DTO_INCREMENT3, 0x1e },
  146. { TM6010_REQ07_R19_CHROMA_DTO_INCREMENT2, 0x8b },
  147. { TM6010_REQ07_R1A_CHROMA_DTO_INCREMENT1, 0xa2 },
  148. { TM6010_REQ07_R1B_CHROMA_DTO_INCREMENT0, 0xe9 },
  149. { TM6010_REQ07_R1C_HSYNC_DTO_INCREMENT3, 0x1c },
  150. { TM6010_REQ07_R1D_HSYNC_DTO_INCREMENT2, 0xcc },
  151. { TM6010_REQ07_R1E_HSYNC_DTO_INCREMENT1, 0xcc },
  152. { TM6010_REQ07_R1F_HSYNC_DTO_INCREMENT0, 0xcd },
  153. { TM6010_REQ07_R2E_ACTIVE_VIDEO_HSTART, 0x88 },
  154. { TM6010_REQ07_R30_ACTIVE_VIDEO_VSTART, 0x22 },
  155. { TM6010_REQ07_R31_ACTIVE_VIDEO_VHIGHT, 0x61 },
  156. { TM6010_REQ07_R33_VSYNC_HLOCK_MAX, 0x1c },
  157. { TM6010_REQ07_R35_VSYNC_AGC_MAX, 0x1c },
  158. { TM6010_REQ07_R82_COMB_FILTER_CONFIG, 0x42 },
  159. { TM6010_REQ07_R83_CHROMA_LOCK_CONFIG, 0x6f },
  160. { TM6010_REQ07_R04_LUMA_HAGC_CONTROL, 0xdd },
  161. { TM6010_REQ07_R0D_CHROMA_KILL_LEVEL, 0x07 },
  162. { TM6010_REQ07_R3F_RESET, 0x00 },
  163. { 0, 0, 0 }
  164. };
  165. static struct tm6000_std_settings composite_stds[] = {
  166. { .id = V4L2_STD_PAL_M, .common = composite_pal_m, },
  167. { .id = V4L2_STD_PAL_Nc, .common = composite_pal_nc, },
  168. { .id = V4L2_STD_PAL, .common = composite_pal, },
  169. { .id = V4L2_STD_SECAM, .common = composite_secam, },
  170. { .id = V4L2_STD_NTSC, .common = composite_ntsc, },
  171. };
  172. static struct tm6000_reg_settings svideo_pal_m[] = {
  173. { TM6010_REQ07_R3F_RESET, 0x01 },
  174. { TM6010_REQ07_R00_VIDEO_CONTROL0, 0x05 },
  175. { TM6010_REQ07_R01_VIDEO_CONTROL1, 0x0e },
  176. { TM6010_REQ07_R02_VIDEO_CONTROL2, 0x5f },
  177. { TM6010_REQ07_R03_YC_SEP_CONTROL, 0x04 },
  178. { TM6010_REQ07_R07_OUTPUT_CONTROL, 0x31 },
  179. { TM6010_REQ07_R18_CHROMA_DTO_INCREMENT3, 0x1e },
  180. { TM6010_REQ07_R19_CHROMA_DTO_INCREMENT2, 0x83 },
  181. { TM6010_REQ07_R1A_CHROMA_DTO_INCREMENT1, 0x0a },
  182. { TM6010_REQ07_R1B_CHROMA_DTO_INCREMENT0, 0xe0 },
  183. { TM6010_REQ07_R1C_HSYNC_DTO_INCREMENT3, 0x1c },
  184. { TM6010_REQ07_R1D_HSYNC_DTO_INCREMENT2, 0xcc },
  185. { TM6010_REQ07_R1E_HSYNC_DTO_INCREMENT1, 0xcc },
  186. { TM6010_REQ07_R1F_HSYNC_DTO_INCREMENT0, 0xcd },
  187. { TM6010_REQ07_R2E_ACTIVE_VIDEO_HSTART, 0x88 },
  188. { TM6010_REQ07_R30_ACTIVE_VIDEO_VSTART, 0x22 },
  189. { TM6010_REQ07_R31_ACTIVE_VIDEO_VHIGHT, 0x61 },
  190. { TM6010_REQ07_R33_VSYNC_HLOCK_MAX, 0x0c },
  191. { TM6010_REQ07_R35_VSYNC_AGC_MAX, 0x1c },
  192. { TM6010_REQ07_R82_COMB_FILTER_CONFIG, 0x52 },
  193. { TM6010_REQ07_R83_CHROMA_LOCK_CONFIG, 0x6f },
  194. { TM6010_REQ07_R04_LUMA_HAGC_CONTROL, 0xdc },
  195. { TM6010_REQ07_R0D_CHROMA_KILL_LEVEL, 0x07 },
  196. { TM6010_REQ07_R3F_RESET, 0x00 },
  197. { 0, 0, 0 }
  198. };
  199. static struct tm6000_reg_settings svideo_pal_nc[] = {
  200. { TM6010_REQ07_R3F_RESET, 0x01 },
  201. { TM6010_REQ07_R00_VIDEO_CONTROL0, 0x37 },
  202. { TM6010_REQ07_R01_VIDEO_CONTROL1, 0x0e },
  203. { TM6010_REQ07_R02_VIDEO_CONTROL2, 0x5f },
  204. { TM6010_REQ07_R03_YC_SEP_CONTROL, 0x04 },
  205. { TM6010_REQ07_R07_OUTPUT_CONTROL, 0x31 },
  206. { TM6010_REQ07_R18_CHROMA_DTO_INCREMENT3, 0x1e },
  207. { TM6010_REQ07_R19_CHROMA_DTO_INCREMENT2, 0x91 },
  208. { TM6010_REQ07_R1A_CHROMA_DTO_INCREMENT1, 0x1f },
  209. { TM6010_REQ07_R1B_CHROMA_DTO_INCREMENT0, 0x0c },
  210. { TM6010_REQ07_R1C_HSYNC_DTO_INCREMENT3, 0x1c },
  211. { TM6010_REQ07_R1D_HSYNC_DTO_INCREMENT2, 0xcc },
  212. { TM6010_REQ07_R1E_HSYNC_DTO_INCREMENT1, 0xcc },
  213. { TM6010_REQ07_R1F_HSYNC_DTO_INCREMENT0, 0xcd },
  214. { TM6010_REQ07_R2E_ACTIVE_VIDEO_HSTART, 0x88 },
  215. { TM6010_REQ07_R30_ACTIVE_VIDEO_VSTART, 0x22 },
  216. { TM6010_REQ07_R31_ACTIVE_VIDEO_VHIGHT, 0xc1 },
  217. { TM6010_REQ07_R33_VSYNC_HLOCK_MAX, 0x0c },
  218. { TM6010_REQ07_R35_VSYNC_AGC_MAX, 0x1c },
  219. { TM6010_REQ07_R82_COMB_FILTER_CONFIG, 0x52 },
  220. { TM6010_REQ07_R83_CHROMA_LOCK_CONFIG, 0x6f },
  221. { TM6010_REQ07_R04_LUMA_HAGC_CONTROL, 0xdc },
  222. { TM6010_REQ07_R0D_CHROMA_KILL_LEVEL, 0x07 },
  223. { TM6010_REQ07_R3F_RESET, 0x00 },
  224. { 0, 0, 0 }
  225. };
  226. static struct tm6000_reg_settings svideo_pal[] = {
  227. { TM6010_REQ07_R3F_RESET, 0x01 },
  228. { TM6010_REQ07_R00_VIDEO_CONTROL0, 0x33 },
  229. { TM6010_REQ07_R01_VIDEO_CONTROL1, 0x0e },
  230. { TM6010_REQ07_R02_VIDEO_CONTROL2, 0x5f },
  231. { TM6010_REQ07_R03_YC_SEP_CONTROL, 0x04 },
  232. { TM6010_REQ07_R07_OUTPUT_CONTROL, 0x30 },
  233. { TM6010_REQ07_R18_CHROMA_DTO_INCREMENT3, 0x25 },
  234. { TM6010_REQ07_R19_CHROMA_DTO_INCREMENT2, 0xd5 },
  235. { TM6010_REQ07_R1A_CHROMA_DTO_INCREMENT1, 0x63 },
  236. { TM6010_REQ07_R1B_CHROMA_DTO_INCREMENT0, 0x50 },
  237. { TM6010_REQ07_R1C_HSYNC_DTO_INCREMENT3, 0x1c },
  238. { TM6010_REQ07_R1D_HSYNC_DTO_INCREMENT2, 0xcc },
  239. { TM6010_REQ07_R1E_HSYNC_DTO_INCREMENT1, 0xcc },
  240. { TM6010_REQ07_R1F_HSYNC_DTO_INCREMENT0, 0xcd },
  241. { TM6010_REQ07_R2E_ACTIVE_VIDEO_HSTART, 0x8c },
  242. { TM6010_REQ07_R30_ACTIVE_VIDEO_VSTART, 0x2a },
  243. { TM6010_REQ07_R31_ACTIVE_VIDEO_VHIGHT, 0xc1 },
  244. { TM6010_REQ07_R33_VSYNC_HLOCK_MAX, 0x0c },
  245. { TM6010_REQ07_R35_VSYNC_AGC_MAX, 0x1c },
  246. { TM6010_REQ07_R82_COMB_FILTER_CONFIG, 0x52 },
  247. { TM6010_REQ07_R83_CHROMA_LOCK_CONFIG, 0x6f },
  248. { TM6010_REQ07_R04_LUMA_HAGC_CONTROL, 0xdc },
  249. { TM6010_REQ07_R0D_CHROMA_KILL_LEVEL, 0x07 },
  250. { TM6010_REQ07_R3F_RESET, 0x00 },
  251. { 0, 0, 0 }
  252. };
  253. static struct tm6000_reg_settings svideo_secam[] = {
  254. { TM6010_REQ07_R3F_RESET, 0x01 },
  255. { TM6010_REQ07_R00_VIDEO_CONTROL0, 0x39 },
  256. { TM6010_REQ07_R01_VIDEO_CONTROL1, 0x0e },
  257. { TM6010_REQ07_R02_VIDEO_CONTROL2, 0x5f },
  258. { TM6010_REQ07_R03_YC_SEP_CONTROL, 0x03 },
  259. { TM6010_REQ07_R07_OUTPUT_CONTROL, 0x31 },
  260. { TM6010_REQ07_R18_CHROMA_DTO_INCREMENT3, 0x24 },
  261. { TM6010_REQ07_R19_CHROMA_DTO_INCREMENT2, 0x92 },
  262. { TM6010_REQ07_R1A_CHROMA_DTO_INCREMENT1, 0xe8 },
  263. { TM6010_REQ07_R1B_CHROMA_DTO_INCREMENT0, 0xed },
  264. { TM6010_REQ07_R1C_HSYNC_DTO_INCREMENT3, 0x1c },
  265. { TM6010_REQ07_R1D_HSYNC_DTO_INCREMENT2, 0xcc },
  266. { TM6010_REQ07_R1E_HSYNC_DTO_INCREMENT1, 0xcc },
  267. { TM6010_REQ07_R1F_HSYNC_DTO_INCREMENT0, 0xcd },
  268. { TM6010_REQ07_R2E_ACTIVE_VIDEO_HSTART, 0x8c },
  269. { TM6010_REQ07_R30_ACTIVE_VIDEO_VSTART, 0x2a },
  270. { TM6010_REQ07_R31_ACTIVE_VIDEO_VHIGHT, 0xc1 },
  271. { TM6010_REQ07_R33_VSYNC_HLOCK_MAX, 0x2c },
  272. { TM6010_REQ07_R35_VSYNC_AGC_MAX, 0x18 },
  273. { TM6010_REQ07_R82_COMB_FILTER_CONFIG, 0x42 },
  274. { TM6010_REQ07_R83_CHROMA_LOCK_CONFIG, 0xff },
  275. { TM6010_REQ07_R0D_CHROMA_KILL_LEVEL, 0x07 },
  276. { TM6010_REQ07_R3F_RESET, 0x00 },
  277. { 0, 0, 0 }
  278. };
  279. static struct tm6000_reg_settings svideo_ntsc[] = {
  280. { TM6010_REQ07_R3F_RESET, 0x01 },
  281. { TM6010_REQ07_R00_VIDEO_CONTROL0, 0x01 },
  282. { TM6010_REQ07_R01_VIDEO_CONTROL1, 0x0f },
  283. { TM6010_REQ07_R02_VIDEO_CONTROL2, 0x5f },
  284. { TM6010_REQ07_R03_YC_SEP_CONTROL, 0x03 },
  285. { TM6010_REQ07_R07_OUTPUT_CONTROL, 0x30 },
  286. { TM6010_REQ07_R17_HLOOP_MAXSTATE, 0x8b },
  287. { TM6010_REQ07_R18_CHROMA_DTO_INCREMENT3, 0x1e },
  288. { TM6010_REQ07_R19_CHROMA_DTO_INCREMENT2, 0x8b },
  289. { TM6010_REQ07_R1A_CHROMA_DTO_INCREMENT1, 0xa2 },
  290. { TM6010_REQ07_R1B_CHROMA_DTO_INCREMENT0, 0xe9 },
  291. { TM6010_REQ07_R1C_HSYNC_DTO_INCREMENT3, 0x1c },
  292. { TM6010_REQ07_R1D_HSYNC_DTO_INCREMENT2, 0xcc },
  293. { TM6010_REQ07_R1E_HSYNC_DTO_INCREMENT1, 0xcc },
  294. { TM6010_REQ07_R1F_HSYNC_DTO_INCREMENT0, 0xcd },
  295. { TM6010_REQ07_R2E_ACTIVE_VIDEO_HSTART, 0x88 },
  296. { TM6010_REQ07_R30_ACTIVE_VIDEO_VSTART, 0x22 },
  297. { TM6010_REQ07_R31_ACTIVE_VIDEO_VHIGHT, 0x61 },
  298. { TM6010_REQ07_R33_VSYNC_HLOCK_MAX, 0x1c },
  299. { TM6010_REQ07_R35_VSYNC_AGC_MAX, 0x1c },
  300. { TM6010_REQ07_R82_COMB_FILTER_CONFIG, 0x42 },
  301. { TM6010_REQ07_R83_CHROMA_LOCK_CONFIG, 0x6f },
  302. { TM6010_REQ07_R04_LUMA_HAGC_CONTROL, 0xdd },
  303. { TM6010_REQ07_R0D_CHROMA_KILL_LEVEL, 0x07 },
  304. { TM6010_REQ07_R3F_RESET, 0x00 },
  305. { 0, 0, 0 }
  306. };
  307. static struct tm6000_std_settings svideo_stds[] = {
  308. { .id = V4L2_STD_PAL_M, .common = svideo_pal_m, },
  309. { .id = V4L2_STD_PAL_Nc, .common = svideo_pal_nc, },
  310. { .id = V4L2_STD_PAL, .common = svideo_pal, },
  311. { .id = V4L2_STD_SECAM, .common = svideo_secam, },
  312. { .id = V4L2_STD_NTSC, .common = svideo_ntsc, },
  313. };
  314. static int tm6000_set_audio_std(struct tm6000_core *dev)
  315. {
  316. uint8_t areg_02 = 0x04; /* GC1 Fixed gain 0dB */
  317. uint8_t areg_05 = 0x01; /* Auto 4.5 = M Japan, Auto 6.5 = DK */
  318. uint8_t areg_06 = 0x02; /* Auto de-emphasis, mannual channel mode */
  319. if (dev->radio) {
  320. tm6000_set_reg(dev, TM6010_REQ08_R01_A_INIT, 0x00);
  321. tm6000_set_reg(dev, TM6010_REQ08_R02_A_FIX_GAIN_CTRL, 0x04);
  322. tm6000_set_reg(dev, TM6010_REQ08_R03_A_AUTO_GAIN_CTRL, 0x00);
  323. tm6000_set_reg(dev, TM6010_REQ08_R04_A_SIF_AMP_CTRL, 0x80);
  324. tm6000_set_reg(dev, TM6010_REQ08_R05_A_STANDARD_MOD, 0x0c);
  325. /* set mono or stereo */
  326. if (dev->amode == V4L2_TUNER_MODE_MONO)
  327. tm6000_set_reg(dev, TM6010_REQ08_R06_A_SOUND_MOD, 0x00);
  328. else if (dev->amode == V4L2_TUNER_MODE_STEREO)
  329. tm6000_set_reg(dev, TM6010_REQ08_R06_A_SOUND_MOD, 0x02);
  330. tm6000_set_reg(dev, TM6010_REQ08_R09_A_MAIN_VOL, 0x18);
  331. tm6000_set_reg(dev, TM6010_REQ08_R0C_A_ASD_THRES2, 0x0a);
  332. tm6000_set_reg(dev, TM6010_REQ08_R0D_A_AMD_THRES, 0x40);
  333. tm6000_set_reg(dev, TM6010_REQ08_RF1_AADC_POWER_DOWN, 0xfe);
  334. tm6000_set_reg(dev, TM6010_REQ08_R1E_A_GAIN_DEEMPH_OUT, 0x13);
  335. tm6000_set_reg(dev, TM6010_REQ08_R01_A_INIT, 0x80);
  336. tm6000_set_reg(dev, TM6010_REQ07_RFE_POWER_DOWN, 0xff);
  337. return 0;
  338. }
  339. /*
  340. * STD/MN shouldn't be affected by tm6010_a_mode, as there's just one
  341. * audio standard for each V4L2_STD type.
  342. */
  343. if ((dev->norm & V4L2_STD_NTSC) == V4L2_STD_NTSC_M_KR) {
  344. areg_05 |= 0x04;
  345. } else if ((dev->norm & V4L2_STD_NTSC) == V4L2_STD_NTSC_M_JP) {
  346. areg_05 |= 0x43;
  347. } else if (dev->norm & V4L2_STD_MN) {
  348. areg_05 |= 0x22;
  349. } else switch (tm6010_a_mode) {
  350. /* auto */
  351. case 0:
  352. if ((dev->norm & V4L2_STD_SECAM) == V4L2_STD_SECAM_L)
  353. areg_05 |= 0x00;
  354. else /* Other PAL/SECAM standards */
  355. areg_05 |= 0x10;
  356. break;
  357. /* A2 */
  358. case 1:
  359. if (dev->norm & V4L2_STD_DK)
  360. areg_05 = 0x09;
  361. else
  362. areg_05 = 0x05;
  363. break;
  364. /* NICAM */
  365. case 2:
  366. if (dev->norm & V4L2_STD_DK) {
  367. areg_05 = 0x06;
  368. } else if (dev->norm & V4L2_STD_PAL_I) {
  369. areg_05 = 0x08;
  370. } else if (dev->norm & V4L2_STD_SECAM_L) {
  371. areg_05 = 0x0a;
  372. areg_02 = 0x02;
  373. } else {
  374. areg_05 = 0x07;
  375. }
  376. break;
  377. /* other */
  378. case 3:
  379. if (dev->norm & V4L2_STD_DK) {
  380. areg_05 = 0x0b;
  381. } else {
  382. areg_05 = 0x02;
  383. }
  384. break;
  385. }
  386. tm6000_set_reg(dev, TM6010_REQ08_R01_A_INIT, 0x00);
  387. tm6000_set_reg(dev, TM6010_REQ08_R02_A_FIX_GAIN_CTRL, areg_02);
  388. tm6000_set_reg(dev, TM6010_REQ08_R03_A_AUTO_GAIN_CTRL, 0x00);
  389. tm6000_set_reg(dev, TM6010_REQ08_R04_A_SIF_AMP_CTRL, 0xa0);
  390. tm6000_set_reg(dev, TM6010_REQ08_R05_A_STANDARD_MOD, areg_05);
  391. tm6000_set_reg(dev, TM6010_REQ08_R06_A_SOUND_MOD, areg_06);
  392. tm6000_set_reg(dev, TM6010_REQ08_R07_A_LEFT_VOL, 0x00);
  393. tm6000_set_reg(dev, TM6010_REQ08_R08_A_RIGHT_VOL, 0x00);
  394. tm6000_set_reg(dev, TM6010_REQ08_R09_A_MAIN_VOL, 0x08);
  395. tm6000_set_reg(dev, TM6010_REQ08_R0A_A_I2S_MOD, 0x91);
  396. tm6000_set_reg(dev, TM6010_REQ08_R0B_A_ASD_THRES1, 0x20);
  397. tm6000_set_reg(dev, TM6010_REQ08_R0C_A_ASD_THRES2, 0x12);
  398. tm6000_set_reg(dev, TM6010_REQ08_R0D_A_AMD_THRES, 0x20);
  399. tm6000_set_reg(dev, TM6010_REQ08_R0E_A_MONO_THRES1, 0xf0);
  400. tm6000_set_reg(dev, TM6010_REQ08_R0F_A_MONO_THRES2, 0x80);
  401. tm6000_set_reg(dev, TM6010_REQ08_R10_A_MUTE_THRES1, 0xc0);
  402. tm6000_set_reg(dev, TM6010_REQ08_R11_A_MUTE_THRES2, 0x80);
  403. tm6000_set_reg(dev, TM6010_REQ08_R12_A_AGC_U, 0x12);
  404. tm6000_set_reg(dev, TM6010_REQ08_R13_A_AGC_ERR_T, 0xfe);
  405. tm6000_set_reg(dev, TM6010_REQ08_R14_A_AGC_GAIN_INIT, 0x20);
  406. tm6000_set_reg(dev, TM6010_REQ08_R15_A_AGC_STEP_THR, 0x14);
  407. tm6000_set_reg(dev, TM6010_REQ08_R16_A_AGC_GAIN_MAX, 0xfe);
  408. tm6000_set_reg(dev, TM6010_REQ08_R17_A_AGC_GAIN_MIN, 0x01);
  409. tm6000_set_reg(dev, TM6010_REQ08_R18_A_TR_CTRL, 0xa0);
  410. tm6000_set_reg(dev, TM6010_REQ08_R19_A_FH_2FH_GAIN, 0x32);
  411. tm6000_set_reg(dev, TM6010_REQ08_R1A_A_NICAM_SER_MAX, 0x64);
  412. tm6000_set_reg(dev, TM6010_REQ08_R1B_A_NICAM_SER_MIN, 0x20);
  413. tm6000_set_reg(dev, REQ_08_SET_GET_AVREG_BIT, 0x1c, 0x00);
  414. tm6000_set_reg(dev, REQ_08_SET_GET_AVREG_BIT, 0x1d, 0x00);
  415. tm6000_set_reg(dev, TM6010_REQ08_R1E_A_GAIN_DEEMPH_OUT, 0x13);
  416. tm6000_set_reg(dev, TM6010_REQ08_R1F_A_TEST_INTF_SEL, 0x00);
  417. tm6000_set_reg(dev, TM6010_REQ08_R20_A_TEST_PIN_SEL, 0x00);
  418. tm6000_set_reg(dev, TM6010_REQ08_R01_A_INIT, 0x80);
  419. return 0;
  420. }
  421. void tm6000_get_std_res(struct tm6000_core *dev)
  422. {
  423. /* Currently, those are the only supported resoltions */
  424. if (dev->norm & V4L2_STD_525_60)
  425. dev->height = 480;
  426. else
  427. dev->height = 576;
  428. dev->width = 720;
  429. }
  430. static int tm6000_load_std(struct tm6000_core *dev, struct tm6000_reg_settings *set)
  431. {
  432. int i, rc;
  433. /* Load board's initialization table */
  434. for (i = 0; set[i].req; i++) {
  435. rc = tm6000_set_reg(dev, set[i].req, set[i].reg, set[i].value);
  436. if (rc < 0) {
  437. printk(KERN_ERR "Error %i while setting req %d, reg %d to value %d\n",
  438. rc, set[i].req, set[i].reg, set[i].value);
  439. return rc;
  440. }
  441. }
  442. return 0;
  443. }
  444. int tm6000_set_standard(struct tm6000_core *dev)
  445. {
  446. struct tm6000_input *input;
  447. int i, rc = 0;
  448. u8 reg_07_fe = 0x8a;
  449. u8 reg_08_f1 = 0xfc;
  450. u8 reg_08_e2 = 0xf0;
  451. u8 reg_08_e6 = 0x0f;
  452. tm6000_get_std_res(dev);
  453. if (!dev->radio)
  454. input = &dev->vinput[dev->input];
  455. else
  456. input = &dev->rinput;
  457. if (dev->dev_type == TM6010) {
  458. switch (input->vmux) {
  459. case TM6000_VMUX_VIDEO_A:
  460. tm6000_set_reg(dev, TM6010_REQ08_RE3_ADC_IN1_SEL, 0xf4);
  461. tm6000_set_reg(dev, TM6010_REQ08_REA_BUFF_DRV_CTRL, 0xf1);
  462. tm6000_set_reg(dev, TM6010_REQ08_REB_SIF_GAIN_CTRL, 0xe0);
  463. tm6000_set_reg(dev, TM6010_REQ08_REC_REVERSE_YC_CTRL, 0xc2);
  464. tm6000_set_reg(dev, TM6010_REQ08_RED_GAIN_SEL, 0xe8);
  465. reg_07_fe |= 0x01;
  466. break;
  467. case TM6000_VMUX_VIDEO_B:
  468. tm6000_set_reg(dev, TM6010_REQ08_RE3_ADC_IN1_SEL, 0xf8);
  469. tm6000_set_reg(dev, TM6010_REQ08_REA_BUFF_DRV_CTRL, 0xf1);
  470. tm6000_set_reg(dev, TM6010_REQ08_REB_SIF_GAIN_CTRL, 0xe0);
  471. tm6000_set_reg(dev, TM6010_REQ08_REC_REVERSE_YC_CTRL, 0xc2);
  472. tm6000_set_reg(dev, TM6010_REQ08_RED_GAIN_SEL, 0xe8);
  473. reg_07_fe |= 0x01;
  474. break;
  475. case TM6000_VMUX_VIDEO_AB:
  476. tm6000_set_reg(dev, TM6010_REQ08_RE3_ADC_IN1_SEL, 0xfc);
  477. tm6000_set_reg(dev, TM6010_REQ08_RE4_ADC_IN2_SEL, 0xf8);
  478. reg_08_e6 = 0x00;
  479. tm6000_set_reg(dev, TM6010_REQ08_REA_BUFF_DRV_CTRL, 0xf2);
  480. tm6000_set_reg(dev, TM6010_REQ08_REB_SIF_GAIN_CTRL, 0xf0);
  481. tm6000_set_reg(dev, TM6010_REQ08_REC_REVERSE_YC_CTRL, 0xc2);
  482. tm6000_set_reg(dev, TM6010_REQ08_RED_GAIN_SEL, 0xe0);
  483. break;
  484. default:
  485. break;
  486. }
  487. switch (input->amux) {
  488. case TM6000_AMUX_ADC1:
  489. tm6000_set_reg_mask(dev, TM6010_REQ08_RF0_DAUDIO_INPUT_CONFIG,
  490. 0x00, 0x0f);
  491. /* Mux overflow workaround */
  492. tm6000_set_reg_mask(dev, TM6010_REQ07_R07_OUTPUT_CONTROL,
  493. 0x10, 0xf0);
  494. break;
  495. case TM6000_AMUX_ADC2:
  496. tm6000_set_reg_mask(dev, TM6010_REQ08_RF0_DAUDIO_INPUT_CONFIG,
  497. 0x08, 0x0f);
  498. /* Mux overflow workaround */
  499. tm6000_set_reg_mask(dev, TM6010_REQ07_R07_OUTPUT_CONTROL,
  500. 0x10, 0xf0);
  501. break;
  502. case TM6000_AMUX_SIF1:
  503. reg_08_e2 |= 0x02;
  504. reg_08_e6 = 0x08;
  505. reg_07_fe |= 0x40;
  506. reg_08_f1 |= 0x02;
  507. tm6000_set_reg(dev, TM6010_REQ08_RE4_ADC_IN2_SEL, 0xf3);
  508. tm6000_set_reg_mask(dev, TM6010_REQ08_RF0_DAUDIO_INPUT_CONFIG,
  509. 0x02, 0x0f);
  510. /* Mux overflow workaround */
  511. tm6000_set_reg_mask(dev, TM6010_REQ07_R07_OUTPUT_CONTROL,
  512. 0x30, 0xf0);
  513. break;
  514. case TM6000_AMUX_SIF2:
  515. reg_08_e2 |= 0x02;
  516. reg_08_e6 = 0x08;
  517. reg_07_fe |= 0x40;
  518. reg_08_f1 |= 0x02;
  519. tm6000_set_reg(dev, TM6010_REQ08_RE4_ADC_IN2_SEL, 0xf7);
  520. tm6000_set_reg_mask(dev, TM6010_REQ08_RF0_DAUDIO_INPUT_CONFIG,
  521. 0x02, 0x0f);
  522. /* Mux overflow workaround */
  523. tm6000_set_reg_mask(dev, TM6010_REQ07_R07_OUTPUT_CONTROL,
  524. 0x30, 0xf0);
  525. break;
  526. default:
  527. break;
  528. }
  529. tm6000_set_reg(dev, TM6010_REQ08_RE2_POWER_DOWN_CTRL1, reg_08_e2);
  530. tm6000_set_reg(dev, TM6010_REQ08_RE6_POWER_DOWN_CTRL2, reg_08_e6);
  531. tm6000_set_reg(dev, TM6010_REQ08_RF1_AADC_POWER_DOWN, reg_08_f1);
  532. tm6000_set_reg(dev, TM6010_REQ07_RFE_POWER_DOWN, reg_07_fe);
  533. } else {
  534. switch (input->vmux) {
  535. case TM6000_VMUX_VIDEO_A:
  536. tm6000_set_reg(dev, TM6000_REQ07_RE3_VADC_INP_LPF_SEL1, 0x10);
  537. tm6000_set_reg(dev, TM6000_REQ07_RE5_VADC_INP_LPF_SEL2, 0x00);
  538. tm6000_set_reg(dev, TM6000_REQ07_RE8_VADC_PWDOWN_CTL, 0x0f);
  539. tm6000_set_reg(dev,
  540. REQ_03_SET_GET_MCU_PIN, input->v_gpio, 0);
  541. break;
  542. case TM6000_VMUX_VIDEO_B:
  543. tm6000_set_reg(dev, TM6000_REQ07_RE3_VADC_INP_LPF_SEL1, 0x00);
  544. tm6000_set_reg(dev, TM6000_REQ07_RE5_VADC_INP_LPF_SEL2, 0x00);
  545. tm6000_set_reg(dev, TM6000_REQ07_RE8_VADC_PWDOWN_CTL, 0x0f);
  546. tm6000_set_reg(dev,
  547. REQ_03_SET_GET_MCU_PIN, input->v_gpio, 0);
  548. break;
  549. case TM6000_VMUX_VIDEO_AB:
  550. tm6000_set_reg(dev, TM6000_REQ07_RE3_VADC_INP_LPF_SEL1, 0x10);
  551. tm6000_set_reg(dev, TM6000_REQ07_RE5_VADC_INP_LPF_SEL2, 0x10);
  552. tm6000_set_reg(dev, TM6000_REQ07_RE8_VADC_PWDOWN_CTL, 0x00);
  553. tm6000_set_reg(dev,
  554. REQ_03_SET_GET_MCU_PIN, input->v_gpio, 1);
  555. break;
  556. default:
  557. break;
  558. }
  559. switch (input->amux) {
  560. case TM6000_AMUX_ADC1:
  561. tm6000_set_reg_mask(dev,
  562. TM6000_REQ07_REB_VADC_AADC_MODE, 0x00, 0x0f);
  563. break;
  564. case TM6000_AMUX_ADC2:
  565. tm6000_set_reg_mask(dev,
  566. TM6000_REQ07_REB_VADC_AADC_MODE, 0x04, 0x0f);
  567. break;
  568. default:
  569. break;
  570. }
  571. }
  572. if (input->type == TM6000_INPUT_SVIDEO) {
  573. for (i = 0; i < ARRAY_SIZE(svideo_stds); i++) {
  574. if (dev->norm & svideo_stds[i].id) {
  575. rc = tm6000_load_std(dev, svideo_stds[i].common);
  576. goto ret;
  577. }
  578. }
  579. return -EINVAL;
  580. } else {
  581. for (i = 0; i < ARRAY_SIZE(composite_stds); i++) {
  582. if (dev->norm & composite_stds[i].id) {
  583. rc = tm6000_load_std(dev, composite_stds[i].common);
  584. goto ret;
  585. }
  586. }
  587. return -EINVAL;
  588. }
  589. ret:
  590. if (rc < 0)
  591. return rc;
  592. if ((dev->dev_type == TM6010) &&
  593. ((input->amux == TM6000_AMUX_SIF1) ||
  594. (input->amux == TM6000_AMUX_SIF2)))
  595. tm6000_set_audio_std(dev);
  596. msleep(40);
  597. return 0;
  598. }