/lge/factory/lge_diag_eri.c

https://bitbucket.org/thenameisnigel/android_kernel_lge_ls840 · C · 245 lines · 175 code · 37 blank · 33 comment · 12 complexity · 70fcbc2485e2e4181ee10a4f49b8f698 MD5 · raw file 

    

  1. /* arch/arm/mach-msm/lge/lg_fw_diag_eri.c
    2. 

  2.  *
    3. 

  3.  * Copyright (C) 2009,2010 LGE, Inc.
    4. 

  4.  *
    5. 

  5.  * This software is licensed under the terms of the GNU General Public
    6. 

  6.  * License version 2, as published by the Free Software Foundation, and
    7. 

  7.  * may be copied, distributed, and modified under those terms.
    8. 

  8.  *
    9. 

  9.  * This program is distributed in the hope that it will be useful,
    10. 

  10.  * but WITHOUT ANY WARRANTY; without even the implied warranty of
    11. 

  11.  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
    12. 

  12.  * GNU General Public License for more details.
    13. 

  13.  *
    14. 

  14.  */
    15. 

  15. 

  16. #include <linux/module.h>
    17. 

  17. #include <linux/fcntl.h> 
    18. 

  18. #include <linux/fs.h>
    19. 

  19. #include <lg_diagcmd.h>
    20. 

  20. #include <linux/uaccess.h>
    21. 

  21. #include <lge_diag_eri.h>
    22. 

  22. 

  23. 

  24. #include <linux/syscalls.h>
    25. 

  25. #include <linux/fcntl.h> 
    26. 

  26. #include <linux/fs.h>
    27. 

  27. #include <linux/uaccess.h>
    28. 

  28. 

  29. #include <linux/module.h>
    30. 

  30. #include <linux/input.h>
    31. 

  31. #include <linux/syscalls.h>
    32. 

  32. #include <linux/delay.h>
    33. 

  33. 

  34. 

  35. #define ERI_FILE_PATH 	"/data/eri/eri.bin"
    36. 

  36. //#define DEBUG_ERI
    37. 

  37. 

  38. /*
    39. 

  39.  * EXTERNAL FUNCTION AND VARIABLE DEFINITIONS
    40. 

  40.  */
    41. 

  41. extern PACK(void *) diagpkt_alloc(diagpkt_cmd_code_type code,unsigned int length);
    42. 

  42. extern PACK(void *) diagpkt_free(PACK(void *)pkt);
    43. 

  43. extern int eri_send_to_arm9(void* pReq, void* pRsp, unsigned int output_length);
    44. 

  44. //extern int eri_send_to_arm9(void* pReq, void* pRsp, unsigned int output_length);
    45. 

  45. 

  46. /* LGE_CHANGE_ [jaekyung83.lee@lge.com] 2011-04-06. ERI UTS AP Write Test  [START]*/
    47. 

  47. static int write_eri(const char *path, eri_write_req_type* write_req_ptr, eri_write_rsp_type* write_rsp_ptr)
    48. 

  48. {
    49. 

  49. 	int write;
    50. 

  50. 	int err;
    51. 

  51. 	mm_segment_t oldfs;
    52. 

  52. #ifdef DEBUG_ERI
    53. 

  53. 	printk(KERN_INFO "%s, UTS ERI Write Test START\n",__func__);
    54. 

  54. #endif
    55. 

  55. 	oldfs = get_fs();
    56. 

  56. 	set_fs(KERNEL_DS);
    57. 

  57. 

  58. #ifdef DEBUG_ERI	
    59. 

  59. 	printk(KERN_ERR "%s, PATH : %s\n",__func__, path);
    60. 

  60. #endif
    61. 

  61. 

  62. 	write = sys_open((const char __user *) path, O_WRONLY | O_CREAT | O_TRUNC , 0);
    63. 

  63. 

  64. 	if(write < 0) {
    65. 

  65. 		printk(KERN_ERR "%s, ERI File Open Fail\n",__func__);
    66. 

  66. 		return -1;
    67. 

  67. 	}else {
    68. 

  68. 		printk(KERN_ERR "%s, ERI File Open Success\n",__func__);
    69. 

  69. 	}
    70. 

  70. 

  71. 	err = sys_write(write, write_req_ptr->eri_data.user_eri_data, write_req_ptr->eri_data.eri_size);
    72. 

  72. 

  73. 	if(err < 0){
    74. 

  74. #ifdef DEBUG_ERI		
    75. 

  75. 		printk(KERN_INFO "%s, ERI File Write Fail\n",__func__);
    76. 

  76. #endif
    77. 

  77. 		write_rsp_ptr->cmd_code = write_req_ptr->cmd_code;
    78. 

  78. 		write_rsp_ptr->sub_cmd_code = write_req_ptr->sub_cmd_code;
    79. 

  79. 		write_rsp_ptr->status = 1;		
    80. 

  80. 	}
    81. 

  81. 	else {
    82. 

  82. #ifdef DEBUG_ERI		
    83. 

  83. 		printk(KERN_INFO "%s, UTS ERI WRITE Test Make Rsp PACK\n",__func__);
    84. 

  84. #endif
    85. 

  85. 		write_rsp_ptr->cmd_code = write_req_ptr->cmd_code;
    86. 

  86. 		write_rsp_ptr->sub_cmd_code = write_req_ptr->sub_cmd_code;
    87. 

  87. 		write_rsp_ptr->status = 0;
    88. 

  88. 	}
    89. 

  89. 	sys_close(write);
    90. 

  90. 	set_fs(oldfs);	
    91. 

  91. 

  92. 	return 1;
    93. 

  93. }
    94. 

  94. /* LGE_CHANGE_ [jaekyung83.lee@lge.com] 2011-04-06. ERI UTS AP Write Test  [END]*/
    95. 

  95. /* LGE_CHANGE_ [jaekyung83.lee@lge.com] 2011-04-06. ERI UTS AP Read Test  [START]*/
    96. 

  96. byte eri_buf[1400];
    97. 

  97. static int read_eri(const char *path, eri_read_req_type* read_req_ptr, eri_read_rsp_type* read_rsp_ptr)
    98. 

  98. {
    99. 

  99. 	int read;
    100. 

  100. //	size_t count;
    101. 

  101. 	int read_size;
    102. 

  102. //	int ret;
    103. 

  103. 	
    104. 

  104. 	mm_segment_t oldfs;
    105. 

  105. 	
    106. 

  106. #ifdef DEBUG_ERI
    107. 

  107. 	printk(KERN_ERR "%s, UTS ERI READ Test START\n",__func__);	
    108. 

  108. #endif
    109. 

  109. 

  110. 	oldfs = get_fs();
    111. 

  111. 	set_fs(KERNEL_DS);
    112. 

  112. 	
    113. 

  113. 	memset(eri_buf,0,sizeof(byte) * 1400);
    114. 

  114. 	
    115. 

  115. 	read = sys_open((const char __user *)path, O_RDONLY , 0);
    116. 

  116. 

  117. 	if(read < 0) {
    118. 

  118. #ifdef DEBUG_ERI		
    119. 

  119. 		printk(KERN_ERR "%s, ERI File Open Fail\n",__func__);
    120. 

  120. #endif
    121. 

  121. 		return -1;
    122. 

  122. 	}else {
    123. 

  123. #ifdef DEBUG_ERI
    124. 

  124. 		printk(KERN_ERR "%s, ERI File Open Success\n",__func__);
    125. 

  125. #endif
    126. 

  126. 	}
    127. 

  127. 

  128. 	read_size = 0;
    129. 

  129. 

  130. 	while(sys_read(read, &eri_buf[read_size++], 1) == 1){}
    131. 

  131. 		
    132. 

  132. 	memcpy(read_rsp_ptr->eri_data.user_eri_data, eri_buf, read_size);
    133. 

  133. 	
    134. 

  134. 	if(read_size <= 0){
    135. 

  135. #ifdef DEBUG_ERI		
    136. 

  136. 		printk(KERN_ERR "%s, ERI File Read Fail\n",__func__);
    137. 

  137. #endif
    138. 

  138. 		read_rsp_ptr->cmd_code = read_req_ptr->cmd_code;
    139. 

  139. 		read_rsp_ptr->sub_cmd_code = read_req_ptr->sub_cmd_code;
    140. 

  140. 		read_rsp_ptr->eri_data.eri_size = 0;
    141. 

  141. 		read_rsp_ptr->status = 1;		
    142. 

  142. 	} else {
    143. 

  143. #ifdef DEBUG_ERI	
    144. 

  144. 		printk(KERN_ERR "%s, UTS ERI READ Test Make Rsp PACK\n",__func__);
    145. 

  145. #endif
    146. 

  146. 		read_rsp_ptr->cmd_code = read_req_ptr->cmd_code;
    147. 

  147. 		read_rsp_ptr->sub_cmd_code = read_req_ptr->sub_cmd_code;
    148. 

  148. 		read_rsp_ptr->eri_data.eri_size = read_size - 1;
    149. 

  149. 		read_rsp_ptr->status = 0;
    150. 

  150. 	}
    151. 

  151. 	set_fs(oldfs);
    152. 

  152. 	sys_close(read);
    153. 

  153. 	return read_size;
    154. 

  154. }
    155. 

  155. /* LGE_CHANGE_ [jaekyung83.lee@lge.com] 2011-04-06. ERI UTS AP Read Test  [END]*/
    156. 

  156. /* LGE_CHANGE_ [jaekyung83.lee@lge.com] 2011-04-06. ERI UTS Test  [START]*/
    157. 

  157. PACK (void *)LGE_ERI (
    158. 

  158.         PACK (void	*)req_pkt_ptr,	/* pointer to request packet  */
    159. 

  159.         uint16		pkt_len )		      /* length of request packet   */
    160. 

  160. {
    161. 

  161. 	eri_req_type* req_ptr = (eri_req_type *)req_pkt_ptr;
    162. 

  162. 	eri_read_rsp_type* read_rsp_ptr = NULL;
    163. 

  163. 	eri_write_rsp_type* write_rsp_ptr = NULL;	
    164. 

  164. 	eri_read_req_type* read_req_ptr = NULL;
    165. 

  165. 	eri_write_req_type* write_req_ptr = NULL;	
    166. 

  166. 	unsigned int rsp_ptr_len;
    167. 

  167. 	int err;
    168. 

  168. 

  169. 	switch(req_ptr->sub_cmd_code)
    170. 

  170. 	{
    171. 

  171. 		case ERI_READ_SUB_CMD_CODE:
    172. 

  172. 			rsp_ptr_len = sizeof(eri_read_rsp_type);
    173. 

  173. 			read_req_ptr = (eri_read_req_type *)req_pkt_ptr;
    174. 

  174. 			read_rsp_ptr = (eri_read_rsp_type*) diagpkt_alloc (DIAG_ERI_CMD_F, sizeof(eri_read_rsp_type));
    175. 

  175. 			err = read_eri(ERI_FILE_PATH, read_req_ptr ,read_rsp_ptr);
    176. 

  176. 

  177. 			if(err < 0){
    178. 

  178. 				read_rsp_ptr->eri_data.eri_size = 0;
    179. 

  179. 				read_rsp_ptr->status = 1;
    180. 

  180. 				memset(read_rsp_ptr->eri_data.user_eri_data, 0, sizeof(read_rsp_ptr->eri_data.user_eri_data));
    181. 

  181. 			}
    182. 

  182. 			return(read_rsp_ptr);
    183. 

  183. 		break;
    184. 

  184. 

  185. 		case ERI_WRITE_SUB_CMD_CODE:
    186. 

  186. 			rsp_ptr_len = sizeof(eri_write_rsp_type);
    187. 

  187. 			write_req_ptr = (eri_write_req_type *)req_pkt_ptr;
    188. 

  188. 			write_rsp_ptr = (eri_write_rsp_type*) diagpkt_alloc (DIAG_ERI_CMD_F, sizeof(eri_write_rsp_type));
    189. 

  189. 			//for writting EFS
    190. 

  190. 			/* LGE_CHANGE_ [jaekyung83.lee@lge.com] 2011-04-06. ERI UTS Write Test EFS /eri/eri.bin   [START]*/
    191. 

  191. 			eri_send_to_arm9((void *)write_req_ptr, (void *)write_rsp_ptr, rsp_ptr_len);
    192. 

  192. 			/* LGE_CHANGE_ [jaekyung83.lee@lge.com] 2011-04-06. ERI UTS Write Test EFS /eri/eri.bin   [END]*/
    193. 

  193. 			//AP /data/eri/eri.bin write
    194. 

  194. 			err = write_eri(ERI_FILE_PATH, write_req_ptr, write_rsp_ptr);
    195. 

  195. 			if(err < 0) {
    196. 

  196. 				write_rsp_ptr->cmd_code = write_req_ptr->cmd_code;
    197. 

  197. 				write_rsp_ptr->sub_cmd_code = write_req_ptr->sub_cmd_code;
    198. 

  198. 				write_rsp_ptr->status = 1;
    199. 

  199. 			}else {
    200. 

  200. 				write_rsp_ptr->cmd_code = write_req_ptr->cmd_code;
    201. 

  201. 				write_rsp_ptr->sub_cmd_code = write_req_ptr->sub_cmd_code;
    202. 

  202. 				write_rsp_ptr->status = 0;
    203. 

  203. 			}
    204. 

  204. 			return (write_rsp_ptr);
    205. 

  205. 		break;	
    206. 

  206. 	}
    207. 

  207. 	return NULL;
    208. 

  208. }
    209. 

  209. 

  210. 

  211. //restore eri.bin  after factory reset command 
    212. 

  212. #ifndef AID_RADIO
    213. 

  213. #define AID_RADIO         1001  /* telephony subsystem, RIL */
    214. 

  214. #endif
    215. 

  215. 

  216. int eri_factory_direct_write(const char *path , char *eri_data, int size )
    217. 

  217. {
    218. 

  218. 	int fd;
    219. 

  219. 	int err;
    220. 

  220. 	mm_segment_t oldfs;
    221. 

  221. 

  222. 	oldfs = get_fs();
    223. 

  223. 	set_fs(KERNEL_DS);
    224. 

  224. 

  225. 

  226. 	fd = sys_open((const char __user *) path, O_WRONLY | O_CREAT | O_TRUNC , 0);
    227. 

  227. 

  228. 	if(fd < 0) {
    229. 

  229. 		printk(KERN_ERR "%s, ERI File Open Fail\n",__func__);
    230. 

  230. 		return -1;
    231. 

  231. 	}else {
    232. 

  232. 		printk(KERN_ERR "%s, ERI File Open Success\n",__func__);
    233. 

  233. 	}
    234. 

  234. 

  235. 	err = sys_write(fd, eri_data, size);
    236. 

  236. 

  237. 	sys_close(fd);
    238. 

  238. 	set_fs(oldfs);	
    239. 

  239. 

  240. 	//change owner and mode so that any apks are able to access
    241. 

  241. 	sys_chown(path, AID_RADIO, AID_RADIO);
    242. 

  242. 	sys_chmod(path, S_IRWXUGO);
    243. 

  243. 	return 1;
    244. 

  244. }
    245. 

  245. /* LGE_CHANGE_ [jaekyung83.lee@lge.com] 2011-04-06. ERI UTS Test  [END]*/
    246.