devbox
AllinToyou
这个屌丝很懒，什么也没留下！
关注作者
热门标签
热门文章
当前位置:   article > 正文

Android RIL 动态切换 4G 模块适配_android 4g拨号上网ril

作者：AllinToyou | 2024-05-23 07:32:52

赞

踩

android 4g拨号上网ril

目录

修改的文件

文件修改说明

runtime.h

Android.mk（在 rild 目录下）

rild.c

Android.mk（在 runtime-ril-port 目录下）

runtime_port.c

如何适配

这个补丁是我加在全志A40 4.4上面的做模块动态适配的 , 毋庸置疑 后面的Android 版本也是适用的 , 比如rockchip 也是没问题的 只是我懒得搞了而已。

调试4G模块非常简单 只是说早期模块经常切换 , 换了还得换固件 , 固件其实只是更换了so库而已。因为kernel driver 已经对vid/pid进行了适配。

这个补丁是直接在hal 层rild 做的vid/pid 然后选择so库文件的。

这个补丁主要修改了 Android RIL (Radio Interface Layer) 的部分代码，以支持动态切换不同的 3G/4G 模块。

修改的文件

  • android/hardware/ril/include/runtime/runtime.h
  • android/hardware/ril/rild/Android.mk
  • android/hardware/ril/rild/rild.c
  • android/hardware/ril/runtime-ril-port/Android.mk
  • android/hardware/ril/runtime-ril-port/runtime_port.c

文件修改说明

runtime.h

这是一个新文件，定义了一些函数和变量，用于启动 uevent 监视器，获取当前的 3G 端口设备，数据和类型。

Android.mk（在 rild 目录下）

在这个 makefile 文件中，添加了 libruntime-ril-port 到 LOCAL_SHARED_LIBRARIES，这样 rild 就可以链接到这个新的库。

rild.c

这个文件中的修改主要是在 rild 的主函数中，添加了对 3G 模块类型的检测，并根据检测到的模块类型，动态地设置 RIL 库的路径。此外，还添加了对 uevent 的监视，当检测到 3G 模块的变化时，会重新启动 rild。

Android.mk（在 runtime-ril-port 目录下）

这是一个新文件，用于编译 runtime_port.c，生成 libruntime-ril-port 库。

runtime_port.c

这是一个新文件，实现了在 runtime.h 中定义的函数。这些函数主要用于检测当前的 3G 模块类型，以及启动对 uevent 的监视。

如何适配

  1. 将这个补丁应用到你的 Android 源码树中。
  2. 根据你的 3G 模块的特性，修改 runtime_port.c 中的 modem_3g_device_table。
  3. 编译并刷入你的 Android 系统。
  4. 当你的设备启动时，rild 会自动检测当前的 3G 模块类型，并加载相应的 RIL 库。

      
    1. diff --git a/android/hardware/ril/include/runtime/runtime.h b/android/hardware/ril/include/runtime/runtime.h
    2. new file mode 100755
    3. index 0000000000..c381b4f2f8
    4. --- /dev/null
    5. +++ b/android/hardware/ril/include/runtime/runtime.h
    6. @@ -0,0 +1,22 @@
    7. +/*
    8. + * Copyright (C) 2011-2013 Freescale Semiconductor, Inc.
    9. + */
    10. +
    11. +#ifndef RUNTIME_H
    12. +#define RUNTIME_H
    13. +
    14. +extern int start_uevent_monitor(void);
    15. +extern const char *runtime_3g_port_device(void);
    16. +extern const char *runtime_3g_port_data(void);
    17. +extern int runtime_3g_port_type(void);
    18. +enum {
    19. +	ME909S_MODEM = 0,
    20. +	U9300C_MODEM,
    21. +	EC20_MODEM,
    22. +	EM8000_MODEM,
    23. +	UNKNOWN_MODEM,
    24. +};
    25. +
    26. +extern int current_modem_type;
    27. +
    28. +#endif
    29. diff --git a/android/hardware/ril/rild/Android.mk b/android/hardware/ril/rild/Android.mk
    30. index d8ca6d368d..83c0a1a130 100755
    31. --- a/android/hardware/ril/rild/Android.mk
    32. +++ b/android/hardware/ril/rild/Android.mk
    33. @@ -13,7 +13,8 @@ LOCAL_SHARED_LIBRARIES := \
    34.  	liblog \
    35.  	libcutils \
    36.  	libril \
    37. -	libdl
    38. +	libdl  \
    39. +	libruntime-ril-port
    40.  
    41.  # temporary hack for broken vendor rils
    42.  #LOCAL_WHOLE_STATIC_LIBRARIES := \
    43. diff --git a/android/hardware/ril/rild/rild.c b/android/hardware/ril/rild/rild.c
    44. index 4a555f275c..e79cd3cb71 100755
    45. --- a/android/hardware/ril/rild/rild.c
    46. +++ b/android/hardware/ril/rild/rild.c
    47. @@ -36,10 +36,19 @@
    48.  #include "hardware/qemu_pipe.h"
    49.  
    50.  #include "radio_monitor.h"
    51. -
    52. +#include <runtime/runtime.h>
    53.  #define LIB_PATH_PROPERTY   "rild.libpath"
    54.  #define LIB_ARGS_PROPERTY   "rild.libargs"
    55.  #define MAX_LIB_ARGS        16
    56. +#define MAX_POLL_DEVICE_CNT 8
    57. +
    58. +
    59. +
    60. +
    61. +#define REFERENCE_RIL_ME909S_PATH "/system/lib/libreference_me909s-ril.so"
    62. +#define REFERENCE_RIL_U9300C_PATH "/system/lib/libreference_u9300c-ril.so"
    63. +#define REFERENCE_RIL_EC20_PATH "/system/lib/libreference_ec20-ril.so"
    64. +#define REFERENCE_RIL_EM8000_PATH "/system/lib/libreference_em8000-ril.so"
    65.  
    66.  static void usage(const char *argv0)
    67.  {
    68. @@ -64,6 +73,7 @@ static struct RIL_Env s_rilEnv = {
    69.      RIL_onUnsolicitedResponse,
    70.      RIL_requestTimedCallback
    71.  };
    72. +static int s_poll_device_cnt = 0;
    73.  
    74.  extern void RIL_startEventLoop();
    75.  
    76. @@ -109,44 +119,21 @@ int main(int argc, char **argv)
    77.      char libPath[PROPERTY_VALUE_MAX];
    78.      unsigned char hasLibArgs = 0;
    79.      int ret = 0;
    80. +	int modem_type = UNKNOWN_MODEM;
    81.      int i;
    82.  	char platform[PROPERTY_VALUE_MAX] = {0};
    83.  
    84.  	//is telephony platform?
    85.  	if(property_get("ro.sw.embeded.telephony", platform, NULL)){
    86.  		if(strcmp(platform, "true")) {
    87. -			RLOGI("platform: wifi-only");
    88. +			RLOGI("platform: wifi-only --1");
    89.  			radio_monitor();
    90.  		}else{
    91. -			RLOGI("platform: telephony");
    92. +			RLOGI("platform: telephony --2");
    93.  		}
    94.  	}
    95.  
    96. -#if 0
    97. -    umask(S_IRGRP | S_IWGRP | S_IXGRP | S_IROTH | S_IWOTH | S_IXOTH);
    98. -    for (i = 1; i < argc ;) {
    99. -        if (0 == strcmp(argv[i], "-l") && (argc - i > 1)) {
    100. -            rilLibPath = argv[i + 1];
    101. -            i += 2;
    102. -        } else if (0 == strcmp(argv[i], "--")) {
    103. -            i++;
    104. -            hasLibArgs = 1;
    105. -            break;
    106. -        } else {
    107. -            usage(argv[0]);
    108. -        }
    109. -    }
    110.  
    111. -    if (rilLibPath == NULL) {
    112. -        if ( 0 == property_get(LIB_PATH_PROPERTY, libPath, NULL)) {
    113. -            // No lib sepcified on the command line, and nothing set in props.
    114. -            // Assume "no-ril" case.
    115. -            goto done;
    116. -        } else {
    117. -            rilLibPath = libPath;
    118. -        }
    119. -    }
    120. -#else
    121.  	ret = property_get(LIB_PATH_PROPERTY, libPath, NULL);
    122.  	if (ret <= 0) {
    123.  		/* nothing to do */
    124. @@ -174,9 +161,62 @@ int main(int argc, char **argv)
    125.  		RLOGD("err: get rilLibPath failed\n");
    126.  		goto done;
    127.  	}
    128. +	///$shh$20180906$add$Dynamic switching module$
    129. +	 //Wait for device ready.
    130. +   // if (rilLibPath == NULL) {
    131. +		while(UNKNOWN_MODEM == modem_type){
    132. +		    modem_type = runtime_3g_port_type();
    133. +		    ALOGD("111 -Couldn't find proper modem, retrying...");
    134. +		    s_poll_device_cnt++;
    135. +		    if (s_poll_device_cnt > MAX_POLL_DEVICE_CNT){
    136. +				/*
    137. +				*Maybe no device right now, start to monitor
    138. +				*hotplug event later.
    139. +				*/
    140. +				start_uevent_monitor();
    141. +				goto done;
    142. +		    }
    143. +		    sleep(5);
    144. +		}
    145. +    //}
    146.  
    147. -#endif
    148. -    RLOGD("\nrilLibPath = %s\n\n", rilLibPath);
    149. +	start_uevent_monitor();
    150. +
    151. +    switch (modem_type){
    152. +		case ME909S_MODEM:
    153. +		{
    154. +			rilLibPath = REFERENCE_RIL_ME909S_PATH;
    155. +			break;
    156. +		}
    157. +		case U9300C_MODEM:
    158. +		{
    159. +		   rilLibPath = REFERENCE_RIL_U9300C_PATH;
    160. +		   break;
    161. +		}
    162. +		case EC20_MODEM:
    163. +		{
    164. +		   rilLibPath = REFERENCE_RIL_EC20_PATH;
    165. +		   break;
    166. +		}
    167. +		case EM8000_MODEM:
    168. +		{
    169. +		   rilLibPath = REFERENCE_RIL_EM8000_PATH;
    170. +		   printf("");
    171. +		   break;
    172. +		}
    173. +
    174. +		if (rilLibPath == NULL) {
    175. +			if ( 0 == property_get(LIB_PATH_PROPERTY, libPath, NULL)) {
    176. +				// No lib sepcified on the command line, and nothing set in props.
    177. +				// Assume "no-ril" case.
    178. +				goto done;
    179. +			} else {
    180. +				rilLibPath = libPath;
    181. +			}
    182. +		}
    183. +	}
    184. +	RLOGD("shh->rilLibPath:%s,modem_type=%d",rilLibPath,modem_type);
    185. +	///$shh$20180906$add$Dynamic switching module$
    186.  
    187.      /* special override when in the emulator */
    188.  #if 0 //ignore this by SW
    189. diff --git a/android/hardware/ril/runtime-ril-port/Android.mk b/android/hardware/ril/runtime-ril-port/Android.mk
    190. new file mode 100755
    191. index 0000000000..fdf21f4844
    192. --- /dev/null
    193. +++ b/android/hardware/ril/runtime-ril-port/Android.mk
    194. @@ -0,0 +1,19 @@
    195. +# Copyright 2006 The Android Open Source Project
    196. +
    197. +LOCAL_PATH:= $(call my-dir)
    198. +include $(CLEAR_VARS)
    199. +
    200. +LOCAL_SRC_FILES:= \
    201. +    runtime_port.c
    202. +
    203. +LOCAL_SHARED_LIBRARIES := \
    204. +    libutils \
    205. +    libcutils
    206. +
    207. +LOCAL_CFLAGS :=
    208. +
    209. +LOCAL_MODULE_TAGS := optional
    210. +LOCAL_MODULE:= libruntime-ril-port
    211. +
    212. +
    213. +include $(BUILD_SHARED_LIBRARY)
    214. diff --git a/android/hardware/ril/runtime-ril-port/runtime_port.c b/android/hardware/ril/runtime-ril-port/runtime_port.c
    215. new file mode 100755
    216. index 0000000000..f7682c7df1
    217. --- /dev/null
    218. +++ b/android/hardware/ril/runtime-ril-port/runtime_port.c
    219. @@ -0,0 +1,452 @@
    220. +/*
    221. + * Licensed under the Apache License, Version 2.0 (the "License");
    222. + * you may not use this file except in compliance with the License.
    223. + * You may obtain a copy of the License at
    224. + *
    225. + *	http://www.apache.org/licenses/LICENSE-2.0
    226. + *
    227. + * Unless required by applicable law or agreed to in writing, software
    228. + * distributed under the License is distributed on an "AS IS" BASIS,
    229. + * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
    230. + * See the License for the specific language governing permissions and
    231. + * limitations under the License.
    232. + */
    233. +
    234. +/*
    235. + * Copyright 2011-2015 Freescale Semiconductor, Inc. All Rights Reserved.
    236. + */
    237. +
    238. +#include <stdio.h>
    239. +#include <string.h>
    240. +#include <stdlib.h>
    241. +#include <dirent.h>
    242. +#include <errno.h>
    243. +#include <fcntl.h>
    244. +#define LOG_TAG "RIL"
    245. +#include <utils/Log.h>
    246. +
    247. +#include <pthread.h>
    248. +#include <sys/types.h>
    249. +#include <sys/socket.h>
    250. +#include <sys/poll.h>
    251. +#include <linux/netlink.h>
    252. +
    253. +#include <signal.h>
    254. +#include <unistd.h>
    255. +#include <runtime/runtime.h>
    256. +
    257. +int current_modem_type = UNKNOWN_MODEM;
    258. +
    259. +#define FAKE_PORT "/dev/ttyFAKEPort"
    260. +/* Rild need a fake port to pass continue init job,
    261. + * return a fake port make it runable.
    262. + * Or the system will enter 15s in early suspend.
    263. + */
    264. +
    265. +struct modem_3g_device {
    266. +	const char *idVendor;
    267. +	const char *idProduct;
    268. +	const char *deviceport;	/* sending AT command */
    269. +	const char *dataport;	/* sending 3g data */
    270. +	const char *name;
    271. +	const int   type;
    272. +};
    273. +
    274. +#define PATH_SIZE 1024
    275. +#define ARRAY_SIZE(a) (sizeof(a)/sizeof(a[0]))
    276. +static const char *USB_DIR_BASE = "/sys/bus/usb/devices/";
    277. +
    278. +static struct modem_3g_device modem_3g_device_table[] = {
    279. +
    280. +	{
    281. +		.name           = "ME909S_MODEM",
    282. +		.idVendor       = "12d1",
    283. +		.idProduct      = "15c1",
    284. +		.deviceport     = "/dev/ttyUSB0",
    285. +		.dataport       = "/dev/ttyUSB2",
    286. +		.type           = ME909S_MODEM,
    287. +	 },
    288. +
    289. +
    290. +	{
    291. +		.name			= "U9300C_MODEM",
    292. +		.idVendor		= "1c9e",
    293. +		.idProduct		= "9b3c",
    294. +		.deviceport = "/dev/ttyUSB1",
    295. +		.dataport		= "/dev/ttyUSB2",
    296. +		.type			= U9300C_MODEM,
    297. +	},
    298. +	{
    299. +		.name			= "EC20_MODEM",
    300. +		.idVendor		= "2c7c",
    301. +		.idProduct		= "0125",
    302. +		.deviceport = "/dev/ttyUSB0",
    303. +		.dataport		= "/dev/ttyUSB2",
    304. +		.type			= EC20_MODEM,
    305. +	},
    306. +	{
    307. +		.name		= "EM8000_MODEM",
    308. +		.idVendor	= "19d2",
    309. +		.idProduct	= "0532",
    310. +		.deviceport     = "/dev/ttyUSB0",
    311. +		.dataport	= "/dev/ttyUSB2",
    312. +		.type		= EM8000_MODEM,
    313. +	},
    314. +};
    315. +
    316. +/* -------------------------------------------------------------- */
    317. +
    318. +#define DEBUG_UEVENT 0
    319. +#define UEVENT_PARAMS_MAX 32
    320. +
    321. +enum uevent_action { action_add, action_remove, action_change };
    322. +
    323. +struct uevent {
    324. +    char *path;
    325. +    enum uevent_action action;
    326. +    char *subsystem;
    327. +    char *param[UEVENT_PARAMS_MAX];
    328. +    unsigned int seqnum;
    329. +};
    330. +
    331. +static void dump_uevent(struct uevent *event);
    332. +
    333. +int readfile(char *path, char *content, size_t size)
    334. +{
    335. +	int ret;
    336. +	FILE *f;
    337. +	f = fopen(path, "r");
    338. +	if (f == NULL)
    339. +		return -1;
    340. +
    341. +	ret = fread(content, 1, size, f);
    342. +	fclose(f);
    343. +	return ret;
    344. +}
    345. +
    346. +int is_device_equal(struct modem_3g_device *device,
    347. +		     const char *idv, const char *idp)
    348. +{
    349. +	long pvid = 0xffff, ppid = 0xffff;
    350. +	long t_vid, t_pid;
    351. +	if (device == NULL)
    352. +		return 0;
    353. +	t_vid = strtol(device->idVendor, NULL, 16);
    354. +	t_pid = strtol(device->idProduct, NULL, 16);
    355. +	pvid = strtol(idv, NULL, 16);
    356. +	ppid = strtol(idp, NULL, 16);
    357. +
    358. +	return (t_vid == pvid && t_pid == ppid);
    359. +}
    360. +
    361. +struct modem_3g_device *
    362. +find_devices_in_table(const char *idvendor, const char *idproduct)
    363. +{
    364. +	int i;
    365. +	int size = ARRAY_SIZE(modem_3g_device_table);
    366. +	struct modem_3g_device *device;
    367. +
    368. +	for (i = 0; i < size; i++) {
    369. +		device = &modem_3g_device_table[i];
    370. +
    371. +		if (is_device_equal(device, idvendor, idproduct)) {
    372. +			ALOGI("Runtime 3G port found matched device with "
    373. +			     "Name:%s idVendor:%s idProduct:%s",
    374. +			     device->name, device->idVendor, device->idProduct);
    375. +
    376. +			return device;
    377. +		}
    378. +	}
    379. +
    380. +	return NULL;
    381. +}
    382. +
    383. +struct modem_3g_device *find_matched_device(void)
    384. +{
    385. +	struct dirent *dent;
    386. +	DIR *usbdir;
    387. +	struct modem_3g_device *device = NULL;
    388. +	char *path, *path2;
    389. +	char idvendor[64];
    390. +	char idproduct[64];
    391. +	int ret, i;
    392. +
    393. +	path = malloc(PATH_SIZE);
    394. +    if (!path)
    395. +        return NULL;
    396. +
    397. +	path2 = malloc(PATH_SIZE);
    398. +    if (!path2) {
    399. +        free(path);
    400. +        return NULL;
    401. +    }
    402. +
    403. +	usbdir = opendir(USB_DIR_BASE);
    404. +	if (usbdir == NULL) {
    405. +		free(path);
    406. +		free(path2);
    407. +		return NULL;
    408. +	}
    409. +
    410. +	memset(path, 0, PATH_SIZE);
    411. +	memset(path2, 0, PATH_SIZE);
    412. +
    413. +	while ((dent = readdir(usbdir)) != NULL) {
    414. +		if (strcmp(dent->d_name, ".") == 0
    415. +		    || strcmp(dent->d_name, "..") == 0)
    416. +			continue;
    417. +		memset(idvendor, 0, sizeof(idvendor));
    418. +		memset(idproduct, 0, sizeof(idproduct));
    419. +		path = strcpy(path, USB_DIR_BASE);
    420. +		path = strcat(path, dent->d_name);
    421. +		strcpy(path2, path);
    422. +		path = strcat(path, "/idVendor");
    423. +		path2 = strcat(path2, "/idProduct");
    424. +
    425. +		ret = readfile(path, idvendor, 4);
    426. +		if (ret <= 0)
    427. +			continue;
    428. +		ret = readfile(path2, idproduct, 4);
    429. +		if (ret <= 0)
    430. +			continue;
    431. +		device = find_devices_in_table(idvendor, idproduct);
    432. +		if (device != NULL)
    433. +			goto out;
    434. +	}
    435. +
    436. +	if (device == NULL)
    437. +		ALOGI("Runtime 3G can't find supported modem");
    438. +out:
    439. +	closedir(usbdir);
    440. +	free(path);
    441. +	free(path2);
    442. +
    443. +	return device;
    444. +}
    445. +
    446. +
    447. +const char *runtime_3g_port_device(void)
    448. +{
    449. +	struct modem_3g_device *device;
    450. +	device = find_matched_device();
    451. +	if (device == NULL)
    452. +		return FAKE_PORT;
    453. +
    454. +	/* Set gobal modem type. */
    455. +	current_modem_type = device->type;
    456. +
    457. +	ALOGI("Current modem type = %d", current_modem_type);
    458. +
    459. +	return device->deviceport;
    460. +}
    461. +
    462. +const char *runtime_3g_port_data(void)
    463. +{
    464. +	struct modem_3g_device *device;
    465. +
    466. +	device = find_matched_device();
    467. +	if (device == NULL)
    468. +		return FAKE_PORT;
    469. +	return device->dataport;
    470. +}
    471. +
    472. +int runtime_3g_port_type(void)
    473. +{
    474. +       struct modem_3g_device *device;
    475. +       int type = UNKNOWN_MODEM;
    476. +       if (UNKNOWN_MODEM == current_modem_type){
    477. +               if (NULL != (device = find_matched_device())){
    478. +                       /* Set gobal modem type. */
    479. +                       type = device->type;
    480. +               }
    481. +       }else{
    482. +               type = current_modem_type;
    483. +       }
    484. +
    485. +       ALOGI("Current modem type = %d", type);
    486. +
    487. +       return type;
    488. +}
    489. +
    490. +static void free_uevent(struct uevent *event)
    491. +{
    492. +    int i;
    493. +    free(event->path);
    494. +    free(event->subsystem);
    495. +    for (i = 0; i < UEVENT_PARAMS_MAX; i++) {
    496. +	    if (!event->param[i])
    497. +		    break;
    498. +	    free(event->param[i]);
    499. +    }
    500. +    free(event);
    501. +}
    502. +
    503. +static int dispatch_uevent(struct uevent *event)
    504. +{
    505. +	/* if it's a usb tty event in our table. make the rild reboot. */
    506. +	int i;
    507. +	int ret;
    508. +	for (i = 0; i < UEVENT_PARAMS_MAX; i++) {
    509. +		if (!event->param[i])
    510. +			break;
    511. +		if (strncmp(event->param[i], "PRODUCT=", 8) == 0) {
    512. +			char vbuf[5], pbuf[5];
    513. +			ret = sscanf(event->param[i],
    514. +				     "PRODUCT=%4s/%4s/", vbuf, pbuf);
    515. +			if (ret < 0)
    516. +				return -1;
    517. +			if (find_devices_in_table(vbuf, pbuf))
    518. +				alarm(1);
    519. +			/* Restart in 1 second, since USB usually have
    520. +			 * many devices, this avoid rild restart too
    521. +			 * many times. */
    522. +		}
    523. +	}
    524. +	return 0;
    525. +}
    526. +
    527. +int process_uevent_message(int sock)
    528. +{
    529. +	char buffer[64 * 1024];
    530. +	char *s = buffer, *p;
    531. +	char *end;
    532. +	int count, param_idx = 0, ret;
    533. +	struct uevent *event;
    534. +	count = recv(sock, buffer, sizeof(buffer), 0);
    535. +	if (count < 0) {
    536. +		ALOGE("Error receiving uevent (%s)", strerror(errno));
    537. +		return -errno;
    538. +	}
    539. +	event = malloc(sizeof(struct uevent));
    540. +	if (!event) {
    541. +		ALOGE("Error allcating memroy (%s)", strerror(errno));
    542. +		return -errno;
    543. +	}
    544. +	memset(event, 0, sizeof(struct uevent));
    545. +
    546. +	end = s + count;
    547. +
    548. +	for (p = s; *p != '@'; p++)
    549. +		;
    550. +	p++;
    551. +	event->path = strdup(p);
    552. +	s += strlen(s) + 1;
    553. +
    554. +	while (s < end) {
    555. +		if (!strncmp(s, "ACTION=", strlen("ACTION="))) {
    556. +			char *a = s + strlen("ACTION=");
    557. +			if (!strcmp(a, "add"))
    558. +				event->action = action_add;
    559. +			else if (!strcmp(a, "change"))
    560. +				event->action = action_change;
    561. +			else if (!strcmp(a, "remove"))
    562. +				event->action = action_remove;
    563. +		} else if (!strncmp(s, "SEQNUM=", strlen("SEQNUM=")))
    564. +			event->seqnum = atoi(s + strlen("SEQNUM="));
    565. +		else if (!strncmp(s, "SUBSYSTEM=", strlen("SUBSYSTEM=")))
    566. +			event->subsystem = strdup(s + strlen("SUBSYSTEM="));
    567. +		else
    568. +			event->param[param_idx++] = strdup(s);
    569. +		s += strlen(s) + 1;
    570. +	}
    571. +
    572. +	ret = dispatch_uevent(event);
    573. +#if DEBUG_UEVENT
    574. +	dump_uevent(event);
    575. +#endif
    576. +	free_uevent(event);
    577. +	return ret;
    578. +}
    579. +
    580. +static void dump_uevent(struct uevent *event)
    581. +{
    582. +    int i;
    583. +
    584. +    ALOGD("[UEVENT] Sq: %u S: %s A: %d P: %s",
    585. +	      event->seqnum, event->subsystem, event->action, event->path);
    586. +    for (i = 0; i < UEVENT_PARAMS_MAX; i++) {
    587. +	    if (!event->param[i])
    588. +		    break;
    589. +	    ALOGD("%s", event->param[i]);
    590. +    }
    591. +}
    592. +
    593. +void restart_rild(int p)
    594. +{
    595. +	ALOGI("3G Modem changed,RILD will restart...");
    596. +	exit(-1);
    597. +}
    598. +
    599. +void *usb_tty_monitor_thread(void *arg)
    600. +{
    601. +	struct sockaddr_nl nladdr;
    602. +	struct pollfd pollfds[2];
    603. +	int uevent_sock;
    604. +	int ret, max = 0;
    605. +	int uevent_sz = 64 * 1024;
    606. +	int timeout = -1;
    607. +	struct sigaction timeoutsigact;
    608. +
    609. +	ALOGI("3G modem monitor thread is start");
    610. +
    611. +	timeoutsigact.sa_handler = restart_rild;
    612. +	sigemptyset(&timeoutsigact.sa_mask);
    613. +	sigaddset(&timeoutsigact.sa_mask, SIGALRM);
    614. +	sigaction(SIGALRM, &timeoutsigact, 0);
    615. +
    616. +	memset(&nladdr, 0, sizeof(nladdr));
    617. +	nladdr.nl_family = AF_NETLINK;
    618. +	nladdr.nl_pid = getpid();
    619. +	nladdr.nl_groups = 0xffffffff;
    620. +
    621. +	uevent_sock = socket(PF_NETLINK, SOCK_DGRAM, NETLINK_KOBJECT_UEVENT);
    622. +	if (uevent_sock < 0) {
    623. +		ALOGE(" Netlink socket faild, usb monitor exiting...");
    624. +		return NULL;
    625. +	}
    626. +
    627. +	if (setsockopt(uevent_sock, SOL_SOCKET, SO_RCVBUFFORCE, &uevent_sz,
    628. +		       sizeof(uevent_sz)) < 0) {
    629. +		ALOGE("Unable to set uevent socket options: %s", strerror(errno));
    630. +		return NULL;
    631. +	}
    632. +
    633. +	if (bind(uevent_sock, (struct sockaddr *) &nladdr, sizeof(nladdr)) < 0) {
    634. +		   ALOGE("Unable to bind uevent socket: %s", strerror(errno));
    635. +		   return NULL;
    636. +	}
    637. +	pollfds[0].fd = uevent_sock;
    638. +	pollfds[0].events = POLLIN;
    639. +
    640. +	ret = fcntl(uevent_sock,F_SETFL, O_NONBLOCK);
    641. +	if (ret < 0)
    642. +		ALOGE("Error on fcntl:%s", strerror(errno));
    643. +
    644. +	while (1) {
    645. +		ret = poll(pollfds, 1, timeout);
    646. +
    647. +		switch (ret) {
    648. +		case 0:
    649. +			ALOGD("poll timeout");
    650. +			continue;
    651. +		case -1:
    652. +			ALOGD("poll error:%s", strerror(errno));
    653. +			break;
    654. +
    655. +		default:
    656. +			if (pollfds[0].revents & POLLIN)
    657. +				process_uevent_message(uevent_sock);
    658. +		}
    659. +	}
    660. +
    661. +	close(uevent_sock);
    662. +}
    663. +
    664. +int start_uevent_monitor(void)
    665. +{
    666. +	pthread_t pth_uevent_monitor;
    667. +	return pthread_create(&pth_uevent_monitor, NULL,
    668. +			      usb_tty_monitor_thread, NULL);
    669. +}
    670. +
    671. +

声明：本文内容由网友自发贡献，不代表【wpsshop博客】立场，版权归原作者所有，本站不承担相应法律责任。如您发现有侵权的内容，请联系我们。转载请注明出处：https://www.wpsshop.cn/w/AllinToyou/article/detail/611914
推荐阅读
相关标签

Copyright © 2003-2013 www.wpsshop.cn 版权所有，并保留所有权利。

  

闽ICP备14008679号