tuner_spi.c 35 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239124012411242124312441245124612471248124912501251125212531254125512561257125812591260126112621263126412651266126712681269127012711272127312741275127612771278127912801281128212831284128512861287128812891290129112921293129412951296129712981299130013011302130313041305130613071308130913101311131213131314131513161317131813191320132113221323132413251326132713281329133013311332133313341335133613371338133913401341134213431344134513461347134813491350135113521353135413551356135713581359136013611362136313641365136613671368
  1. /*
  2. *
  3. * drivers/media/isdbtmm/tuner_spi.c
  4. *
  5. * MM Tuner Driver
  6. *
  7. * Copyright (C) (2013, Samsung Electronics)
  8. *
  9. * This program is free software; you can redistribute it and/or modify
  10. * it under the terms of the GNU General Public License as published by
  11. * the Free Software Foundation version 2.
  12. *
  13. * This program is distributed "as is" WITHOUT ANY WARRANTY of any
  14. * kind, whether express or implied; without even the implied warranty
  15. * of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  16. * GNU General Public License for more details.
  17. *
  18. */
  19. #include <linux/kernel.h>
  20. #include <linux/fs.h>
  21. #include <linux/errno.h>
  22. #include <linux/device.h>
  23. #include <linux/platform_device.h>
  24. #include <linux/init.h>
  25. #include <linux/module.h>
  26. #include <linux/string.h>
  27. #include <linux/types.h>
  28. #include <linux/fcntl.h>
  29. #include <linux/spi/spi.h>
  30. #include <linux/wakelock.h>
  31. #include <linux/kthread.h>
  32. #include <linux/spinlock.h>
  33. #include <linux/sched.h>
  34. /* for delay(sleep) */
  35. #include <linux/delay.h>
  36. /* for mutex */
  37. #include <linux/mutex.h>
  38. /*using copy to user */
  39. #include <linux/uaccess.h>
  40. #include <linux/clk.h>
  41. #include <linux/mm.h>
  42. #include <linux/slab.h>
  43. #include <linux/workqueue.h>
  44. #include <linux/irq.h>
  45. #include <asm/mach/irq.h>
  46. #include <linux/interrupt.h>
  47. #include <linux/vmalloc.h>
  48. #include <linux/io.h>
  49. #include <mach/gpio.h>
  50. #include "tuner_spi.h"
  51. #include "tuner.h"
  52. #include "tuner_drv_sys.h"
  53. /******************************************************************************/
  54. /*** ***/
  55. /******************************************************************************/
  56. DEFINE_MUTEX ( smt1113j_spi_device_lock );
  57. #define MAX_BUFFER_PKT 0x1000 /* 4MByte */
  58. #define MAX_RX_PACKET 100 /* 100Packet */
  59. #define LOOP_RX_PAKET 20 /* 20Packet */
  60. //#define MAX_LOOP_CNT 5 /* spi loop cnt */
  61. #define PAKCET_SIZE 188 /* 1Packet size */
  62. #define LOOP_RX_PACKET_BYTE (LOOP_RX_PAKET * PAKCET_SIZE) /* 20 * 188Byte */
  63. /* Debug Log */
  64. /* #define USER_BUF_DEBUG */ /* User Area Buffer Write Debug Log */
  65. /* #define KERNEL_BUF_DEBUG */ /* Kernel Area Buffer Write Buffer Debug Log */
  66. /******************************************************************************/
  67. /*** ***/
  68. /******************************************************************************/
  69. static struct class *SMT113J_SPI_class = NULL;
  70. static struct spi_device *smt113j_spi_device = NULL;
  71. static struct wake_lock smt113j_spi_wake_lock;
  72. /*** packet control info ***/
  73. static unsigned char rx_pkt_buffer[(MAX_BUFFER_PKT * PAKCET_SIZE)] = { 0 };
  74. static unsigned char rx_buf_temp[PAKCET_SIZE * 256] = { 0 };
  75. static unsigned int pwrite = 0;
  76. static unsigned int pread = 0;
  77. static unsigned char spi_buf[(PAKCET_SIZE * LOOP_RX_PAKET)] __cacheline_aligned;
  78. /*** open count ***/
  79. static unsigned int spi_open_cnt = 0;
  80. static unsigned int max_loop_count = 5;
  81. /******************************************************************************/
  82. /*** ***/
  83. /******************************************************************************/
  84. /*** System Call ***/
  85. static int SMT113J_SPI_open (struct inode *inode,
  86. struct file *filp );
  87. static int SMT113J_SPI_release (struct inode *inode,
  88. struct file *filp );
  89. static ssize_t SMT113J_SPI_read (struct file *filp,
  90. char *buf, size_t count,
  91. loff_t * f_pos );
  92. static int SMT113J_SPI_write (struct file *filp,
  93. const char __user * buf,
  94. size_t count,
  95. loff_t * f_pos );
  96. static long SMT113J_SPI_ioctl (struct file *filp,
  97. unsigned int cmd,
  98. unsigned long arg );
  99. /*** Platform Registory Call ***/
  100. static int SMT113J_SPI_remove ( struct platform_device *pdev );
  101. static int SMT113J_SPI_probe ( struct platform_device *pdev );
  102. /*** SPI Driver Registory Call ***/
  103. static int smt113j_spi_probe ( struct spi_device *spi );
  104. static int __devexit smt113j_spi_remove ( struct spi_device *spi );
  105. /*** thread control ***/
  106. static int smt113j_spi_thread_Init ( void );
  107. static int smt113j_spi_thread_Start ( void );
  108. static int smt113j_spi_thread_Stop ( void );
  109. static int smt113j_spi_thread_loop ( void *arg );
  110. static int smt113j_spi_thread_read ( void );
  111. /*** IOCTL ***/
  112. static int smt113j_spi_cmd_bufstat ( unsigned char *status );
  113. static int smt113j_spi_cmd_pktsync ( void );
  114. static int smt113j_spi_cmd_init ( void );
  115. static int smt113j_spi_cmd_pktread ( unsigned char *temp_buf );
  116. /******************************************************************************/
  117. /*** ***/
  118. /******************************************************************************/
  119. static const struct file_operations SMT113J_SPI_ctl_fops = {
  120. .owner = THIS_MODULE,
  121. .open = SMT113J_SPI_open,
  122. .write = SMT113J_SPI_write,
  123. .read = SMT113J_SPI_read,
  124. .unlocked_ioctl = SMT113J_SPI_ioctl,
  125. .release = SMT113J_SPI_release,
  126. };
  127. static const struct of_device_id tmm_spi_data_match_table[] = {
  128. { .compatible = "isdbtmm_spi_data",
  129. },
  130. {}
  131. };
  132. static struct platform_driver SMT113J_SPI_driver = {
  133. .probe = SMT113J_SPI_probe,
  134. .remove = SMT113J_SPI_remove,
  135. .driver = {
  136. .owner = THIS_MODULE,
  137. .name = "tmmspi",
  138. .of_match_table = tmm_spi_data_match_table,
  139. },
  140. };
  141. static const struct of_device_id tmm_spi_match_table[] = {
  142. { .compatible = "isdbtmm_spi_comp",
  143. },
  144. {}
  145. };
  146. static struct spi_driver smt113j_spi_driver = {
  147. .probe = smt113j_spi_probe,
  148. .remove = __devexit_p(smt113j_spi_remove),
  149. .driver = {
  150. .name = "tmmspidev",
  151. .owner = THIS_MODULE,
  152. .of_match_table = tmm_spi_match_table,
  153. },
  154. };
  155. /******************************************************************************/
  156. /*** ***/
  157. /******************************************************************************/
  158. static int smt113j_spi_cmd_init ( void )
  159. {
  160. int ret = 0;
  161. ioctl_spi_internal_reg spi_command = { 0 };
  162. struct spi_message m = {{ 0 }};
  163. struct spi_transfer t[3] = {{ 0 }};
  164. /*** SPI message init ***/
  165. spi_message_init ( &m );
  166. /*** SPI command set ***/
  167. spi_command.cmd = 0x01;
  168. spi_command.data = 0xB1;
  169. /*** transfer data set ***/
  170. t[0].tx_buf = &spi_command;
  171. t[0].rx_buf = NULL;
  172. t[0].len = sizeof ( spi_command );
  173. spi_message_add_tail ( &t[0], &m );
  174. /*** SPI transfer request ***/
  175. ret = spi_sync ( smt113j_spi_device, &m );
  176. if ( 0 > ret )
  177. {
  178. ERROR_PRINT ("smt113j_spi_cmd_init : Sync Error << ret = %d >>", ret );
  179. }
  180. printk("smt113j_spi_cmd_init << End : %d >>\n", ret );
  181. return ( ret );
  182. }
  183. /******************************************************************************/
  184. /*** ***/
  185. /******************************************************************************/
  186. static int smt113j_spi_cmd_pktsync ( void )
  187. {
  188. int ret = 0;
  189. ioctl_spi_pktsync spi_command = { 0 };
  190. struct spi_message m = {{ 0 }};
  191. struct spi_transfer t[3] = {{ 0 }};
  192. /*** SPI message init ***/
  193. spi_message_init ( &m );
  194. /*** SPI command set ***/
  195. spi_command.cmd = 0xD8;
  196. spi_command.dum1 = 0x00;
  197. spi_command.dum2 = 0x00;
  198. spi_command.dum3 = 0x00;
  199. /*** transfer data set ***/
  200. t[0].tx_buf = &spi_command;
  201. t[0].rx_buf = NULL;
  202. t[0].len = sizeof ( spi_command );
  203. spi_message_add_tail ( &t[0], &m );
  204. /*** SPI transfer request ***/
  205. ret = spi_sync ( smt113j_spi_device, &m );
  206. if ( 0 > ret )
  207. {
  208. ERROR_PRINT ("smt113j_spi_cmd_pktsync : Sync Error << ret = %d >>",
  209. ret );
  210. }
  211. printk("smt113j_spi_cmd_pktsync << End : %d >>\n", ret );
  212. return ( ret );
  213. }
  214. /******************************************************************************/
  215. /*** ***/
  216. /******************************************************************************/
  217. static int smt113j_spi_cmd_bufstat ( unsigned char *status )
  218. {
  219. int ret = 0;
  220. unsigned char data = 0;
  221. ioctl_spi_bufstatus spi_command = { 0 };
  222. struct spi_message m = {{ 0 }};
  223. struct spi_transfer t[3] = {{ 0 }};
  224. DEBUG_PRINT("smt113j_spi_cmd_bufstat << Start : %x >>",
  225. (unsigned int)*status );
  226. /*** argument check ***/
  227. if ( NULL == status )
  228. {
  229. ERROR_PRINT ("smt113j_spi_cmd_bufstat : Parameter Error");
  230. return ( -EINVAL );
  231. }
  232. /*** SPI message init ***/
  233. spi_message_init ( &m );
  234. /*** SPI command set ***/
  235. spi_command.cmd = 0x03;
  236. spi_command.read = 0x10;
  237. spi_command.addr = 0x00;
  238. spi_command.dum = 0x00;
  239. /*** transfer data set ***/
  240. t[0].tx_buf = &spi_command;
  241. t[0].rx_buf = NULL;
  242. t[0].len = sizeof ( spi_command );
  243. spi_message_add_tail ( &t[0], &m );
  244. /*** transfer data set ***/
  245. t[1].tx_buf = NULL;
  246. t[1].rx_buf = &data;
  247. t[1].len = sizeof ( unsigned char );
  248. spi_message_add_tail ( &t[1], &m );
  249. /*** SPI transfer request ***/
  250. ret = spi_sync ( smt113j_spi_device, &m );
  251. if ( 0 > ret )
  252. {
  253. ERROR_PRINT ("smt113j_spi_cmd_bufstat : Sync Error << ret = %d >>",
  254. ret );
  255. }
  256. /*** read data set ***/
  257. *status = data;
  258. DEBUG_PRINT("smt113j_spi_cmd_bufstat << End : %x >>", *status );
  259. return ( ret );
  260. }
  261. /******************************************************************************/
  262. /*** ***/
  263. /******************************************************************************/
  264. static int smt113j_spi_cmd_pktread ( unsigned char *temp_buf )
  265. {
  266. int ret = 0;
  267. int loop = 0;
  268. static ioctl_spi_pktread spi_command __cacheline_aligned;
  269. struct spi_message m = {{ 0 }};
  270. struct spi_transfer t[3] = {{ 0 }};
  271. DEBUG_PRINT("smt113j_spi_cmd_pktread << Start >>");
  272. /*** argument check ***/
  273. if ( NULL == temp_buf )
  274. {
  275. ERROR_PRINT (
  276. "smt113j_spi_cmd_pktread : Paramerter Error << parm = %x >>",
  277. (unsigned int)temp_buf );
  278. return ( -EINVAL );
  279. }
  280. /*** SPI command set ***/
  281. spi_command.cmd = 0x0B;
  282. spi_command.dum1 = 0x00;
  283. /* TS Packet Size ( 0 : 188 Byte or 1: 204 Byte ) */
  284. spi_command.size = 0x00;
  285. /* TS Packet Num ( 20 : LOOP_RX_PAKET + 1 ) */
  286. spi_command.read_pkt = (LOOP_RX_PAKET - 1);
  287. spi_command.dum2 = 0x00;
  288. // for ( loop = 0; loop < MAX_LOOP_CNT; loop++ )
  289. for ( loop = 0; loop < max_loop_count; loop++ )
  290. {
  291. /*** SPI message init ***/
  292. spi_message_init ( &m );
  293. memset ( t, 0, sizeof ( t ));
  294. memset ( spi_buf, 0, sizeof ( spi_buf ));
  295. /*** transfer data set ***/
  296. t[0].tx_buf = &spi_command;
  297. t[0].rx_buf = NULL;
  298. t[0].len = sizeof ( spi_command );
  299. spi_message_add_tail ( &t[0], &m );
  300. /*** transfer data set ***/
  301. t[1].tx_buf = NULL;
  302. t[1].rx_buf = &spi_buf;
  303. t[1].len = sizeof ( unsigned char ) * LOOP_RX_PACKET_BYTE;
  304. spi_message_add_tail ( &t[1], &m );
  305. /*** SPI transfer request ***/
  306. ret = spi_sync ( smt113j_spi_device, &m );
  307. if ( 0 > ret )
  308. {
  309. ERROR_PRINT ("smt113j_spi_cmd_pktread : Sync Error << ret = %d >>",
  310. ret );
  311. break;
  312. }
  313. /*** read data copy ***/
  314. memcpy ( temp_buf,
  315. spi_buf,
  316. sizeof ( unsigned char ) * ( LOOP_RX_PACKET_BYTE ));
  317. temp_buf += LOOP_RX_PACKET_BYTE;
  318. }
  319. DEBUG_PRINT("smt113j_spi_cmd_pktread << End : %x >>", ret );
  320. return ( ret );
  321. }
  322. /******************************************************************************/
  323. /*** ***/
  324. /******************************************************************************/
  325. static int SMT113J_SPI_open(struct inode *inode, struct file *filp)
  326. {
  327. int ret = 0;
  328. unsigned int majorno = 0,
  329. minorno = 0;
  330. unsigned char *devarea = NULL;
  331. majorno = imajor(filp->f_dentry->d_inode);
  332. minorno = iminor(filp->f_dentry->d_inode);
  333. if (( majorno != NODE_MAJOR ) ||
  334. ( minorno != NODE_MINOR ))
  335. {
  336. ERROR_PRINT ("SMT113J_SPI_open Error : << No MAJOR(%d) or No MINOR(%d)",
  337. majorno,
  338. minorno );
  339. return ( -ENODEV );
  340. }
  341. /*** Private Data Area MALLOC Stataus Check ***/
  342. if ( NULL != ( devarea = (unsigned char *)filp->private_data ))
  343. {
  344. ERROR_PRINT(
  345. "SMT113J_SPI_open Error : << Used Private Data Area[0x%08x] >>",
  346. (int)devarea );
  347. return ( -ENODEV );
  348. }
  349. /*** Private Data Area Alloc ***/
  350. if ( NULL == ( devarea = (unsigned char *)kmalloc (
  351. sizeof(smt113j_ioctl_data), GFP_KERNEL )))
  352. {
  353. ERROR_PRINT(
  354. "SMT113J_SPI_open Error : << Used Private Data Area Alloc Error");
  355. return ( -ENOMEM ) ;
  356. }
  357. memset ( devarea, 0, sizeof ( smt113j_ioctl_data ));
  358. filp->private_data = (void *)devarea;
  359. /*** buffer clear ***/
  360. memset ( rx_pkt_buffer, 0, MAX_BUFFER_PKT * PAKCET_SIZE );
  361. pwrite = 0;
  362. pread = 0;
  363. spi_open_cnt++;
  364. printk("SMT113J_SPI_open << End >>, spi_open_cnt = %d\n", spi_open_cnt);
  365. return ( ret );
  366. }
  367. /******************************************************************************/
  368. /*** ***/
  369. /******************************************************************************/
  370. static int SMT113J_SPI_release(struct inode *inode, struct file *filp)
  371. {
  372. int ret = 0;
  373. /*** Device Open Check ***/
  374. if ( 0 == spi_open_cnt )
  375. {
  376. ERROR_PRINT ("No Open Devices");
  377. return ( ret );
  378. }
  379. spi_open_cnt--;
  380. if ( 0 != spi_open_cnt )
  381. {
  382. ERROR_PRINT ("Not Relase : Open Device Num[%d]", spi_open_cnt );
  383. return ( ret );
  384. }
  385. /*** Private Data Area Check ***/
  386. if ( NULL == (unsigned char *)filp->private_data )
  387. {
  388. ERROR_PRINT("No Private Data");
  389. return ( ret );
  390. }
  391. /*** thread stop ***/
  392. smt113j_spi_thread_Stop();
  393. memset ( (unsigned char *)filp->private_data,
  394. 0,
  395. sizeof ( smt113j_ioctl_data ));
  396. kfree ( filp->private_data );
  397. filp->private_data = NULL;
  398. /*** buffer clear ***/
  399. memset ( rx_pkt_buffer, 0, MAX_BUFFER_PKT * PAKCET_SIZE );
  400. pwrite = 0;
  401. pread = 0;
  402. printk("SMT113J_SPI_release << End >>, ret = %d\n", ret);
  403. return ret;
  404. }
  405. /******************************************************************************/
  406. /*** ***/
  407. /******************************************************************************/
  408. static ssize_t SMT113J_SPI_read(struct file *filp,
  409. char *buf,
  410. size_t count,
  411. loff_t * f_pos)
  412. {
  413. int ret = 0;
  414. int cnt = 0;
  415. int get_packet = 0;
  416. int tmp = 0;
  417. int ring_flg = 0;
  418. #ifdef USER_BUF_DEBUG
  419. DEBUG_PRINT("SMT113J_SPI_read << Start >>");
  420. #endif /* USER_BUF_DEBUG */
  421. /*** Thread Status Check ***/
  422. if ( SMT113J_SPI_SYNC_RUN != spi_work_thread->status )
  423. {
  424. /*** no packet */
  425. printk("SMT113J_SPI_read << End : No Packet Sync Command(%d) >>\n",
  426. spi_work_thread->status );
  427. return ( 0 );
  428. }
  429. if ( pwrite == pread )
  430. {
  431. /*** not received packet ***/
  432. printk("SMT113J_SPI_read << End : No Packet in kernel buffer>>\n");
  433. return ( 0 );
  434. }
  435. /*** calculation of the packet acquisition ***/
  436. if ( pwrite > pread )
  437. {
  438. /* not ring */
  439. get_packet = ( pwrite - pread ) / PAKCET_SIZE;
  440. ring_flg = 0;
  441. }
  442. else
  443. {
  444. /* ring */
  445. get_packet = ( pwrite + (MAX_BUFFER_PKT * PAKCET_SIZE) - pread )
  446. / PAKCET_SIZE;
  447. ring_flg = 1;
  448. }
  449. #ifdef USER_BUF_DEBUG
  450. DEBUG_PRINT("SMT113J_SPI_read << ring : %d >>", ring_flg );
  451. DEBUG_PRINT("-> pread = %d", pread );
  452. DEBUG_PRINT("-> pwrite = %d", pwrite );
  453. DEBUG_PRINT("-> get_packet = %d", get_packet );
  454. DEBUG_PRINT("-> Buffer Start Address = %x", &rx_pkt_buffer[0] );
  455. DEBUG_PRINT("-> Buffer End Address = %x",
  456. &rx_pkt_buffer[(MAX_BUFFER_PKT * PAKCET_SIZE) - 1] );
  457. #endif /* USER_BUF_DEBUG */
  458. if ( count > get_packet )
  459. {
  460. /* not ring */
  461. if ( 0 == ring_flg )
  462. {
  463. if ( copy_to_user ( buf, &rx_pkt_buffer[pread],
  464. PAKCET_SIZE * get_packet ))
  465. {
  466. ERROR_PRINT(
  467. "SMT113J_SPI_read * copy_to_user1 Error << ret = %d >>",
  468. ret );
  469. return ( -1 );
  470. }
  471. cnt = get_packet;
  472. pread += ( get_packet * PAKCET_SIZE );
  473. #ifdef USER_BUF_DEBUG
  474. DEBUG_PRINT("-> Update RX Pcket = %d", cnt );
  475. DEBUG_PRINT("-> Update pread = %d", pread );
  476. #endif /* USER_BUF_DEBUG */
  477. }
  478. /* ring */
  479. else
  480. {
  481. if ( copy_to_user ( buf, &rx_pkt_buffer[pread],
  482. ( PAKCET_SIZE * ( MAX_BUFFER_PKT )) - pread ))
  483. {
  484. ERROR_PRINT(
  485. "SMT113J_SPI_read * copy_to_user2 Error << ret = %d >>",
  486. ret );
  487. return ( -1 );
  488. }
  489. #ifdef USER_BUF_DEBUG
  490. DEBUG_PRINT("-> buf = %x", buf );
  491. DEBUG_PRINT("-> update pread = %d", pread );
  492. #endif /* USER_BUF_DEBUG */
  493. cnt = (( PAKCET_SIZE * MAX_BUFFER_PKT ) - pread ) / PAKCET_SIZE;
  494. buf += ( PAKCET_SIZE * MAX_BUFFER_PKT ) - pread;
  495. #ifdef USER_BUF_DEBUG
  496. DEBUG_PRINT("-> buf = %x", buf );
  497. DEBUG_PRINT("-> update RX Packet = %d", cnt );
  498. DEBUG_PRINT("-> Ring Buffer Control" );
  499. #endif /* USER_BUF_DEBUG */
  500. tmp = ( get_packet - cnt );
  501. if ( copy_to_user ( buf, &rx_pkt_buffer[0], PAKCET_SIZE * tmp))
  502. {
  503. ERROR_PRINT(
  504. "SMT113J_SPI_read * copy_to_user3 Error << ret = %d >>",
  505. ret );
  506. return ( cnt );
  507. }
  508. cnt += tmp;
  509. pread = (PAKCET_SIZE * tmp);
  510. #ifdef USER_BUF_DEBUG
  511. DEBUG_PRINT("-> pread = %d", pread );
  512. DEBUG_PRINT("-> update RX Packet = %d", cnt );
  513. #endif /* USER_BUF_DEBUG */
  514. }
  515. }
  516. else
  517. {
  518. /*** not ring ***/
  519. if ( 0 == ring_flg )
  520. {
  521. if ( copy_to_user ( buf, &rx_pkt_buffer[pread],
  522. PAKCET_SIZE * count ))
  523. {
  524. ERROR_PRINT(
  525. "SMT113J_SPI_read * copy_to_user3 Error << ret = %d >>",
  526. ret );
  527. return ( -1 );
  528. }
  529. cnt = count;
  530. pread += ( count * PAKCET_SIZE);
  531. #ifdef USER_BUF_DEBUG
  532. DEBUG_PRINT("-> pread = %d", pread );
  533. DEBUG_PRINT("-> update RX Packet = %d", cnt );
  534. #endif /* USER_BUF_DEBUG */
  535. }
  536. /*** ring ***/
  537. else
  538. {
  539. cnt = 0;
  540. if ( count <= (MAX_BUFFER_PKT - (pread / PAKCET_SIZE)))
  541. {
  542. if ( copy_to_user ( buf, &rx_pkt_buffer[pread],
  543. PAKCET_SIZE * count ))
  544. {
  545. ERROR_PRINT(
  546. "SMT113J_SPI_read * copy_to_user3 Error << ret = %d >>",
  547. ret );
  548. return ( -1 );
  549. }
  550. cnt = count;
  551. pread += ( count * PAKCET_SIZE);
  552. }
  553. else
  554. {
  555. if ( copy_to_user ( buf, &rx_pkt_buffer[pread],
  556. ( PAKCET_SIZE * MAX_BUFFER_PKT ) - pread ))
  557. {
  558. ERROR_PRINT(
  559. "SMT113J_SPI_read * copy_to_user3 Error << ret = %d >>",
  560. ret );
  561. return ( -1 );
  562. }
  563. cnt = MAX_BUFFER_PKT - ( pread / PAKCET_SIZE );
  564. buf += cnt * PAKCET_SIZE;
  565. tmp = ( count - cnt );
  566. if ( copy_to_user ( buf, &rx_pkt_buffer[0], PAKCET_SIZE * tmp ))
  567. {
  568. ERROR_PRINT(
  569. "SMT113J_SPI_read * copy_to_user3 Error << ret = %d >>",
  570. ret );
  571. return ( -1 );
  572. }
  573. cnt += tmp;
  574. pread = ( PAKCET_SIZE * tmp);
  575. }
  576. #ifdef USER_BUF_DEBUG
  577. DEBUG_PRINT("-> End pread = %d", pread );
  578. DEBUG_PRINT("-> End pwrite = %d", pwrite );
  579. DEBUG_PRINT("-> update RX Packet = %d", cnt );
  580. #endif /* USER_BUF_DEBUG */
  581. }
  582. }
  583. #ifdef USER_BUF_DEBUG
  584. DEBUG_PRINT("SMT113J_SPI_read << End >>");
  585. #else
  586. DEBUG_PRINT("SMT113J_SPI_read read packet = %d", cnt);
  587. #endif
  588. return ( cnt );
  589. }
  590. /******************************************************************************/
  591. /*** ***/
  592. /******************************************************************************/
  593. static int SMT113J_SPI_write(struct file *filp,
  594. const char __user * buf,
  595. size_t count,
  596. loff_t * f_pos)
  597. {
  598. DEBUG_PRINT("SMT113J_SPI_write << Not Sppurt >>");
  599. return ( -ENOTSUPP );
  600. }
  601. /******************************************************************************/
  602. /*** ***/
  603. /******************************************************************************/
  604. static long SMT113J_SPI_ioctl(struct file *filp,
  605. unsigned int cmd,
  606. unsigned long arg)
  607. {
  608. int ret = 0;
  609. unsigned char pkt_status = 0;
  610. TUNER_DATA_SPI_RW *debug_buf = (TUNER_DATA_SPI_RW*)arg;
  611. DEBUG_PRINT("SMT113J_SPI_ioctl << Start >>");
  612. switch ( cmd )
  613. {
  614. /*** SPI INIT ***/
  615. case TUNER_SPI_IOCTL_INIT:
  616. printk ("-> TUNER_SPI_IOCTL_INIT\n");
  617. ret = smt113j_spi_cmd_init();
  618. break;
  619. /*** thread stop ***/
  620. case TUNER_SPI_IOCTL_PKTANSYNC:
  621. printk ("-> TUNER_SPI_IOCTL_PKTANSYNC\n");
  622. smt113j_spi_thread_Stop();
  623. break;
  624. /*** SPI Packet Synchronize ***/
  625. case TUNER_SPI_IOCTL_PKTSYNC:
  626. printk ("-> TUNER_SPI_IOCTL_PKTSYNC\n");
  627. if (debug_buf->buf == NULL) {
  628. printk ("debug_buf->buf is NULL. Setting max_loop_count to default\n");
  629. max_loop_count = 5;
  630. } else if (*debug_buf->buf == 1) {
  631. max_loop_count = 3;
  632. } else {
  633. max_loop_count = 5;
  634. }
  635. smt113j_spi_thread_Stop();
  636. ret = smt113j_spi_cmd_pktsync();
  637. smt113j_spi_thread_Start();
  638. break;
  639. /*** SPI Buffer Status ***/
  640. case TUNER_SPI_IOCTL_BUFSTAT:
  641. printk ("-> TUNER_SPI_IOCTL_BUFSTAT\n");
  642. ret = smt113j_spi_cmd_bufstat ( &pkt_status );
  643. if ( 0 != ret )
  644. {
  645. pkt_status = 0;
  646. ERROR_PRINT ("-> put_user(arg_data->moni_cnt) Error : ret = %d",
  647. ret );
  648. break;
  649. }
  650. /* Copy to User Area */
  651. ret = put_user ( pkt_status,
  652. (unsigned int __user *)&(debug_buf->val) );
  653. if ( 0 != ret )
  654. {
  655. ERROR_PRINT ("-> put_user(arg_data->moni_cnt) Error : ret = %d",
  656. ret );
  657. break;
  658. }
  659. DEBUG_PRINT ("-> pkt_status = %d", pkt_status );
  660. break;
  661. /*** SPI TS Packet Read ***/
  662. case TUNER_SPI_IOCTL_READPKT:
  663. ret = smt113j_spi_cmd_pktread ( rx_buf_temp );
  664. if ( 0 > ret )
  665. {
  666. ERROR_PRINT("TUNER_SPI_IOCTL_READPKT : Error << ret = %d >>",
  667. ret );
  668. break;
  669. }
  670. ret = copy_to_user ( rx_buf_temp,
  671. (unsigned char *)debug_buf->buf, 256 );
  672. if ( 0 > ret )
  673. {
  674. ERROR_PRINT(
  675. "TUNER_SPI_IOCTL_READPKT * copy_to_user Error << ret = %d >>",
  676. ret );
  677. }
  678. break;
  679. default:
  680. DEBUG_PRINT ("-> SMT113J_SPI_ioctl : No Coomand Case");
  681. ret = -EINVAL;
  682. break;
  683. }
  684. DEBUG_PRINT("SMT113J_SPI_ioctl << End >> : ret = %d", ret );
  685. return ( ret ) ;
  686. }
  687. /******************************************************************************
  688. * function: smt113j_spi_thread_Init
  689. * brief :
  690. * date :
  691. * author :
  692. *
  693. * return : none
  694. * input : none
  695. * output : none
  696. ******************************************************************************/
  697. static int smt113j_spi_thread_Init ( void )
  698. {
  699. int ret = 0;
  700. struct sched_param param = { .sched_priority = 99 };
  701. spi_work_thread = kmalloc ( sizeof ( smt113j_spi_thread_t ), GFP_KERNEL );
  702. if ( !spi_work_thread )
  703. {
  704. ERROR_PRINT ("smt113j_spi_thread_Init : Kmalloc Error");
  705. return ( -EFAULT );
  706. }
  707. spi_work_thread->status = SMT113J_SPI_SYNC_STOP;
  708. spin_lock_init( &spi_work_thread->tmm_lock );
  709. init_waitqueue_head ( &spi_work_thread->thread_wait );
  710. /*** Thread generation and run ***/
  711. spi_work_thread->thread_task = kthread_run ( smt113j_spi_thread_loop,
  712. NULL,
  713. "SMT113J_SPI_Task" );
  714. if ( IS_ERR ( spi_work_thread->thread_task ))
  715. {
  716. ERROR_PRINT ("smt113j_spi_thread_Init : kthread_run error : %p",
  717. spi_work_thread->thread_task);
  718. goto ERROR2;
  719. }
  720. ret = sched_setscheduler ( spi_work_thread->thread_task,
  721. SCHED_FIFO,
  722. &param );
  723. if ( ret < 0 )
  724. {
  725. ERROR_PRINT (
  726. "smt113j_spi_thread_Init : sched_setscheduler error ret[ %d ]",
  727. ret );
  728. goto ERROR3;
  729. }
  730. printk("smt113j_spi_thread_Init: End\n");
  731. return ( ret );
  732. ERROR3:
  733. spi_work_thread->status = SMT113J_SPI_SYNC_STOP;
  734. wake_up_interruptible ( &( spi_work_thread->thread_wait ));
  735. kthread_stop ( spi_work_thread->thread_task );
  736. ERROR2:
  737. kfree ( spi_work_thread );
  738. ERROR_PRINT ("smt113j_spi_thread_Init : Error");
  739. return ( ret );
  740. }
  741. /******************************************************************************
  742. * function: smt113j_spi_thread_Start
  743. * brief :
  744. * date :
  745. * author :
  746. *
  747. * return : none
  748. * input : none
  749. * output : none
  750. ******************************************************************************/
  751. static int smt113j_spi_thread_Start ( void )
  752. {
  753. printk("-> spi_work_thread->status[%d]\n", spi_work_thread->status );
  754. /* multiple check */
  755. if ( SMT113J_SPI_SYNC_RUN == spi_work_thread->status )
  756. {
  757. DEBUG_PRINT("smt113j_spi_thread_Start( Double ) : End!");
  758. return ( 0 );
  759. }
  760. /* thread run status set */
  761. spi_work_thread->status = SMT113J_SPI_SYNC_RUN;
  762. pwrite = 0;
  763. pread = 0;
  764. wake_lock(&smt113j_spi_wake_lock);
  765. /* wakeup event */
  766. wake_up_interruptible ( &(spi_work_thread->thread_wait ));
  767. DEBUG_PRINT("smt113j_spi_thread_Start : End!");
  768. DEBUG_PRINT("-> spi_work_thread->status[%d]", spi_work_thread->status );
  769. return ( 0 );
  770. }
  771. /******************************************************************************
  772. * function: smt113j_spi_thread_Start
  773. * brief :
  774. * date :
  775. * author :
  776. *
  777. * return : none
  778. * input : none
  779. * output : none
  780. ******************************************************************************/
  781. static int smt113j_spi_thread_Stop ( void )
  782. {
  783. DEBUG_PRINT("smt113j_spi_thread_Stop : Start! << %s >>",
  784. ((spi_work_thread->status == SMT113J_SPI_SYNC_STOP)?
  785. "SMT113J_SPI_SYNC_STOP":
  786. (spi_work_thread->status == SMT113J_SPI_SYNC_RUN)?
  787. "SMT113J_SPI_SYNC_RUN":"other"));
  788. DEBUG_PRINT("-> spi_work_thread->status [%d]", spi_work_thread->status );
  789. mutex_lock(&smt1113j_spi_device_lock);
  790. spi_work_thread->status = SMT113J_SPI_SYNC_STOP;
  791. mutex_unlock(&smt1113j_spi_device_lock);
  792. wake_unlock(&smt113j_spi_wake_lock);
  793. DEBUG_PRINT("smt113j_spi_thread_Stop : End! << %s >>",
  794. ((spi_work_thread->status == SMT113J_SPI_SYNC_STOP)?
  795. "SMT113J_SPI_SYNC_STOP":
  796. (spi_work_thread->status == SMT113J_SPI_SYNC_RUN)?
  797. "SMT113J_SPI_SYNC_RUN":"other"));
  798. DEBUG_PRINT("-> spi_work_thread->status [%d]", spi_work_thread->status );
  799. return ( 0 );
  800. }
  801. /******************************************************************************
  802. * function: smt113j_spi_thread_loop
  803. * brief :
  804. * date :
  805. * author :
  806. *
  807. * return : none
  808. * input : none
  809. * output : none
  810. ******************************************************************************/
  811. static int smt113j_spi_thread_loop ( void *arg )
  812. {
  813. int ret = 0;
  814. unsigned char status = 0;
  815. printk("smt113j_spi_thread_loop : Start!\n");
  816. while ( !kthread_should_stop() )
  817. {
  818. DEBUG_PRINT("smt113j_spi_thread_loop : spi_work_thread->status[%d]!",
  819. spi_work_thread->status );
  820. /* wait event */
  821. if ( SMT113J_SPI_SYNC_RUN != spi_work_thread->status )
  822. {
  823. DEBUG_PRINT("smt113j_spi_thread_loop : Thread Wait!");
  824. ret = wait_event_interruptible ( spi_work_thread->thread_wait,
  825. SMT113J_SPI_SYNC_STOP != spi_work_thread->status );
  826. if ( 0 != ret )
  827. {
  828. DEBUG_PRINT ("Not Interruptible : No Case");
  829. continue;
  830. }
  831. DEBUG_PRINT(
  832. "smt113j_spi_thread_loop : Thread Run << status[%d] >>!",
  833. spi_work_thread->status );
  834. }
  835. /*** SPI Sync ***/
  836. switch ( spi_work_thread->status )
  837. {
  838. /*** SPI Sync Command ***/
  839. case SMT113J_SPI_SYNC_RUN:
  840. mutex_lock(&smt1113j_spi_device_lock);
  841. if ( spi_work_thread->status == SMT113J_SPI_SYNC_RUN )
  842. {
  843. /*** TS Buffering Status ***/
  844. ret = smt113j_spi_cmd_bufstat ( &status );
  845. }
  846. mutex_unlock(&smt1113j_spi_device_lock);
  847. if ( 0 > ret )
  848. {
  849. ERROR_PRINT ("smt113j_spi_thread_loop : Pakcet Error = %d",
  850. ret );
  851. continue;
  852. }
  853. DEBUG_PRINT("smt113j_spi_thread_loop : data ready buf = 0x%x", status);
  854. /*** Pakcet state ( status = 0x00<not ready>/0x01<ready> ) ***/
  855. if ( 0x01 == ( status & 0x01 ))
  856. {
  857. DEBUG_PRINT (
  858. "smt113j_spi_thread_read() before : status[%d]",
  859. spi_work_thread->status );
  860. mutex_lock(&smt1113j_spi_device_lock);
  861. if ( spi_work_thread->status == SMT113J_SPI_SYNC_RUN )
  862. {
  863. /*** Buffer Ready ***/
  864. smt113j_spi_thread_read();
  865. }
  866. mutex_unlock(&smt1113j_spi_device_lock);
  867. DEBUG_PRINT (
  868. "smt113j_spi_thread_read() after : status[%d]",
  869. spi_work_thread->status );
  870. }
  871. else
  872. {
  873. printk("smt113j_spi_thread_loop : No data in tuner buffer or Error occured\n");
  874. /*** inside chip buffer is over or under run check ***/
  875. if ( 0 != ( status & 0x06 ))
  876. {
  877. /*** Over or Under Run ***/
  878. ERROR_PRINT (
  879. "smt113j_spi_thread_loop : buffer Error < %s >",
  880. ((0x02 == (status & 0x02))?
  881. "Under-run":((0x04 == (status & 0x04))?
  882. "Over-run":"No Error")));
  883. smt113j_spi_cmd_pktsync();
  884. }
  885. else
  886. {
  887. DEBUG_PRINT (
  888. "smt113j_spi_thread_loop : Buffering Wait");
  889. }
  890. /* 20ms sleep */
  891. usleep_range (( 20 * 1000 ), ( 20 * 1000 ));
  892. }
  893. break;
  894. default:
  895. /*** Thread Status Error ***/
  896. ERROR_PRINT (
  897. "smt113j_spi_thread_loop : Thread Status Error : %d",
  898. spi_work_thread->status );
  899. spi_work_thread->status = SMT113J_SPI_SYNC_STOP;
  900. break;
  901. }
  902. }
  903. DEBUG_PRINT("smt113j_spi_thread_loop : End!");
  904. return ( 0 );
  905. }
  906. /******************************************************************************
  907. * function: smt113j_spi_thread_read
  908. * brief :
  909. * date :
  910. * author :
  911. *
  912. * return : none
  913. * input : none
  914. * output : none
  915. ******************************************************************************/
  916. static int smt113j_spi_thread_read ( void )
  917. {
  918. int ret = 0;
  919. #ifdef KERNEL_BUF_DEBUG
  920. int cnt = 0;
  921. int temp_write = pwrite;
  922. #endif /* KERNEL_BUF_DEBUG */
  923. DEBUG_PRINT("smt113j_spi_thread_read : Start!");
  924. /*** Read Packet***/
  925. ret = smt113j_spi_cmd_pktread ( rx_buf_temp );
  926. #ifdef KERNEL_BUF_DEBUG
  927. DEBUG_PRINT("pwrite = %d", pwrite );
  928. DEBUG_PRINT("pread = %d", pread );
  929. /*** debug test ***/
  930. for ( cnt = 0; cnt < 20; cnt++ )
  931. {
  932. DEBUG_PRINT("read[0x%02x][0x%02x][0x%02x][0x%02x][0x%02x]!",
  933. rx_buf_temp[pread + (cnt*188)+0],
  934. rx_buf_temp[pread + (cnt*188)+1],
  935. rx_buf_temp[pread + (cnt*188)+2],
  936. rx_buf_temp[pread + (cnt*188)+3],
  937. rx_buf_temp[pread + (cnt*188)+4] );
  938. }
  939. #endif /* KERNEL_BUF_DEBUG */
  940. if ( 0 > ret )
  941. {
  942. ERROR_PRINT ("smt113j_spi_thread_read : Pakcet Error = %d", ret );
  943. return ( ret );
  944. }
  945. if ((( pwrite / PAKCET_SIZE ) + MAX_RX_PACKET ) > MAX_BUFFER_PKT )
  946. {
  947. memcpy ( &rx_pkt_buffer[pwrite],
  948. rx_buf_temp,
  949. (PAKCET_SIZE * MAX_BUFFER_PKT) - pwrite );
  950. #ifdef KERNEL_BUF_DEBUG
  951. for ( cnt = 0; cnt < 20; cnt++ )
  952. {
  953. DEBUG_PRINT(
  954. "read[0x%02x][0x%02x][0x%02x][0x%02x][0x%02x]!",
  955. rx_pkt_buffer[pwrite+(cnt*188)+0],
  956. rx_pkt_buffer[pwrite+(cnt*188)+1],
  957. rx_pkt_buffer[pwrite+(cnt*188)+2],
  958. rx_pkt_buffer[pwrite+(cnt*188)+3],
  959. rx_pkt_buffer[pwrite+(cnt*188)+4] );
  960. }
  961. #endif /* KERNEL_BUF_DEBUG */
  962. memcpy ( rx_pkt_buffer,
  963. &rx_buf_temp[(PAKCET_SIZE * MAX_BUFFER_PKT) - pwrite],
  964. ( PAKCET_SIZE * MAX_RX_PACKET ) -
  965. (( PAKCET_SIZE * MAX_BUFFER_PKT ) - pwrite ));
  966. #ifdef KERNEL_BUF_DEBUG
  967. for ( cnt = 0; cnt < 20; cnt++ )
  968. {
  969. DEBUG_PRINT(
  970. "read[0x%02x][0x%02x][0x%02x][0x%02x][0x%02x]!",
  971. rx_pkt_buffer[(cnt*188)+0],
  972. rx_pkt_buffer[(cnt*188)+1],
  973. rx_pkt_buffer[(cnt*188)+2],
  974. rx_pkt_buffer[(cnt*188)+3],
  975. rx_pkt_buffer[(cnt*188)+4] );
  976. }
  977. #endif /* KERNEL_BUF_DEBUG */
  978. pwrite = ((PAKCET_SIZE * MAX_RX_PACKET) -
  979. ((PAKCET_SIZE * MAX_BUFFER_PKT) - pwrite ));
  980. }
  981. else
  982. {
  983. memcpy ( &rx_pkt_buffer[pwrite],
  984. rx_buf_temp,
  985. PAKCET_SIZE * MAX_RX_PACKET );
  986. pwrite += (PAKCET_SIZE * MAX_RX_PACKET);
  987. #ifdef KERNEL_BUF_DEBUG
  988. for ( cnt = 0; cnt < 20; cnt++ )
  989. {
  990. DEBUG_PRINT(
  991. "read[0x%02x][0x%02x][0x%02x][0x%02x][0x%02x]!",
  992. rx_pkt_buffer[temp_write+(cnt*188)+0],
  993. rx_pkt_buffer[temp_write+(cnt*188)+1],
  994. rx_pkt_buffer[temp_write+(cnt*188)+2],
  995. rx_pkt_buffer[temp_write+(cnt*188)+3],
  996. rx_pkt_buffer[temp_write+(cnt*188)+4] );
  997. }
  998. #endif /* KERNEL_BUF_DEBUG */
  999. }
  1000. DEBUG_PRINT("smt113j_spi_thread_read : End!");
  1001. return ( ret );
  1002. }
  1003. /******************************************************************************/
  1004. /*** ***/
  1005. /******************************************************************************/
  1006. static int smt113j_spi_probe(struct spi_device *spi)
  1007. {
  1008. int ret;
  1009. spi->bits_per_word = 8;
  1010. spi->mode = SPI_MODE_0;
  1011. spi->max_speed_hz = (27 * 1000 * 1000); /* 30MHz */
  1012. ret = spi_setup ( spi );
  1013. if ( ret < 0 )
  1014. {
  1015. ERROR_PRINT("smt113j_spi_probe : spi_setup Failed = %d!", ret );
  1016. return ( ret );
  1017. }
  1018. smt113j_spi_device = spi;
  1019. wake_lock_init ( &smt113j_spi_wake_lock,
  1020. WAKE_LOCK_SUSPEND,
  1021. "smt113j_spi_wake_lock" );
  1022. printk("smt113j_spi_probe : End!\n");
  1023. return ( 0 );
  1024. }
  1025. /******************************************************************************/
  1026. /*** ***/
  1027. /******************************************************************************/
  1028. static int __devexit smt113j_spi_remove(struct spi_device *spi)
  1029. {
  1030. smt113j_spi_device = NULL;
  1031. printk ("smt113j_spi_remove : End\n");
  1032. return 0;
  1033. }
  1034. /******************************************************************************/
  1035. /*** ***/
  1036. /******************************************************************************/
  1037. static int SMT113J_SPI_probe(struct platform_device *pdev)
  1038. {
  1039. int ret;
  1040. struct device *SMT113J_SPI_dev;
  1041. ret = register_chrdev ( NODE_MAJOR, NODE_PATHNAME, &SMT113J_SPI_ctl_fops );
  1042. if ( 0 > ret )
  1043. {
  1044. ERROR_PRINT("SMT113J_SPI_probe : register_chrdev failed : ret = %d!",
  1045. ret );
  1046. return ( -EFAULT );
  1047. }
  1048. SMT113J_SPI_class = class_create(THIS_MODULE, NODE_PATHNAME);
  1049. if (IS_ERR(SMT113J_SPI_class))
  1050. {
  1051. ERROR_PRINT("SMT113J_SPI_probe : class_create failed : ret = %d!",
  1052. ret );
  1053. unregister_chrdev(NODE_MAJOR, NODE_PATHNAME);
  1054. class_destroy(SMT113J_SPI_class);
  1055. return ( -EFAULT );
  1056. }
  1057. SMT113J_SPI_dev = device_create ( SMT113J_SPI_class,
  1058. NULL,
  1059. MKDEV(NODE_MAJOR, NODE_MINOR),
  1060. NULL,
  1061. NODE_PATHNAME);
  1062. if (IS_ERR(SMT113J_SPI_dev))
  1063. {
  1064. ERROR_PRINT("SMT113J_SPI_probe : device_create failed : ret = %d!",
  1065. ret );
  1066. unregister_chrdev(NODE_MAJOR, NODE_PATHNAME);
  1067. class_destroy(SMT113J_SPI_class);
  1068. return ( -EFAULT );
  1069. }
  1070. ret = spi_register_driver ( &smt113j_spi_driver );
  1071. if (ret < 0)
  1072. {
  1073. ERROR_PRINT(
  1074. "SMT113J_SPI_probe : spi_register_driver failed : ret = %d!",
  1075. ret );
  1076. return ( -EBUSY );
  1077. }
  1078. smt113j_spi_thread_Init();
  1079. printk("SMT113J_SPI_probe : End!\n");
  1080. return 0;
  1081. }
  1082. /******************************************************************************/
  1083. /*** ***/
  1084. /******************************************************************************/
  1085. static int SMT113J_SPI_remove ( struct platform_device *pdev )
  1086. {
  1087. int ret = 0;
  1088. spi_unregister_driver ( &smt113j_spi_driver );
  1089. printk("SMT113J SMT113J_SPI_remove : End\n");
  1090. return ( ret );
  1091. }
  1092. /******************************************************************************/
  1093. /*** ***/
  1094. /******************************************************************************/
  1095. int SMT113J_SPI_init(void)
  1096. {
  1097. int ret = 0;
  1098. DEBUG_PRINT("SMT113J_SPI_init : Start");
  1099. ret = platform_driver_register ( &SMT113J_SPI_driver );
  1100. if ( ret )
  1101. {
  1102. ERROR_PRINT("SMT113J_SPI_init : Error = %x", ret);
  1103. return ( ret );
  1104. }
  1105. DEBUG_PRINT("SMT113J_SPI_init : End = %x", ret);
  1106. return ( 0 );
  1107. }
  1108. /******************************************************************************/
  1109. /*** ***/
  1110. /******************************************************************************/
  1111. void SMT113J_SPI_exit(void)
  1112. {
  1113. DEBUG_PRINT("SMT113J SMT113J_SPI_exit : Start");
  1114. unregister_chrdev ( NODE_MAJOR, NODE_PATHNAME );
  1115. device_destroy ( SMT113J_SPI_class, MKDEV(NODE_MAJOR, NODE_MINOR ));
  1116. class_destroy ( SMT113J_SPI_class );
  1117. platform_driver_unregister ( &SMT113J_SPI_driver );
  1118. DEBUG_PRINT("SMT113J SMT113J_SPI_exit : End");
  1119. return;
  1120. }
  1121. /******************************************************************************/
  1122. /*** ***/
  1123. /******************************************************************************/
  1124. MODULE_AUTHOR("Samsung");
  1125. MODULE_DESCRIPTION("ISDBTMM Driver");
  1126. MODULE_LICENSE("GPL v2");