int main(int argc, char **argv) { int door_sock = -1; int uevent_sock = -1; struct sockaddr_nl nladdr; int uevent_sz = 64 * 1024; LOGI("Android Display Daemon version %d.%d", ver_major, ver_minor); /* * Create all the various sockets we'll need */ // Socket to listen on for incomming framework connections if ((door_sock = android_get_control_socket(DISPD_SOCKET)) < 0) { LOGE("Obtaining file descriptor socket '%s' failed: %s", DISPD_SOCKET, strerror(errno)); exit(1); } if (listen(door_sock, 4) < 0) { LOGE("Unable to listen on fd '%d' for socket '%s': %s", door_sock, DISPD_SOCKET, strerror(errno)); exit(1); } mkdir("/dev/block/dispd", 0755); // Socket to listen on for uevent changes memset(&nladdr, 0, sizeof(nladdr)); nladdr.nl_family = AF_NETLINK; nladdr.nl_pid = getpid(); nladdr.nl_groups = 0xffffffff; if ((uevent_sock = socket(PF_NETLINK, SOCK_DGRAM,NETLINK_KOBJECT_UEVENT)) < 0) { LOGE("Unable to create uevent socket: %s", strerror(errno)); exit(1); } if (setsockopt(uevent_sock, SOL_SOCKET, SO_RCVBUFFORCE, &uevent_sz, sizeof(uevent_sz)) < 0) { LOGE("Unable to set uevent socket options: %s", strerror(errno)); exit(1); } if (bind(uevent_sock, (struct sockaddr *) &nladdr, sizeof(nladdr)) < 0) { LOGE("Unable to bind uevent socket: %s", strerror(errno)); exit(1); } /* * Bootstrap */ bootstrap = 1; // Switch switch_bootstrap(); dvi_detection_bootstrap(); hdmi_detection_bootstrap(); bootstrap = 0; /* * Main loop */ LOG_DISP("Bootstrapping complete"); while(1) { fd_set read_fds; struct timeval to; int max = 0; int rc = 0; to.tv_sec = (60 * 60); to.tv_usec = 0; FD_ZERO(&read_fds); FD_SET(door_sock, &read_fds); if (door_sock > max) max = door_sock; FD_SET(uevent_sock, &read_fds); if (uevent_sock > max) max = uevent_sock; if (fw_sock != -1) { FD_SET(fw_sock, &read_fds); if (fw_sock > max) max = fw_sock; } if ((rc = select(max + 1, &read_fds, NULL, NULL, &to)) < 0) { LOGE("select() failed (%s)", strerror(errno)); sleep(1); continue; } if (!rc) { continue; } if (FD_ISSET(door_sock, &read_fds)) { struct sockaddr addr; socklen_t alen; alen = sizeof(addr); if (fw_sock != -1) { LOGE("Dropping duplicate framework connection"); int tmp = accept(door_sock, &addr, &alen); close(tmp); continue; } if ((fw_sock = accept(door_sock, &addr, &alen)) < 0) { LOGE("Unable to accept framework connection (%s)", strerror(errno)); } LOG_DISP("Accepted connection from framework"); //Send the states whether the disp already been connected through fw_sock if ((rc = dispmgr_send_status()) < 0) { LOGE("Unable to send dispmgr status to framework (%d)", rc); } } if (FD_ISSET(fw_sock, &read_fds)) { LOG_DISP("process cmd from framework"); if ((rc = process_framework_command(fw_sock)) < 0) { if (rc == -ECONNRESET) { LOGE("Framework disconnected"); close(fw_sock); fw_sock = -1; } else { LOGE("Error processing framework command (%s)", strerror(errno)); } } } if (FD_ISSET(uevent_sock, &read_fds)) { //LOG_DISP("process uevent from kernel"); if ((rc = process_uevent_message(uevent_sock)) < 0) { LOGE("Error processing uevent msg (%s)", strerror(errno)); } } } // while }
int main(int argc,char* args[]){ //TODO read device name from args char **tgmArgv; void *dlHandle; const TGM_RadioFunctions *(*tgmInit)(const struct TGM_Env *, int, char **); //define a varible that hold a pointer to init function const TGM_RadioFunctions *funcs; // define a varbile that hold a pointer to TGM_RadioFunctions structure char libPath[PROPERTY_VALUE_MAX]; unsigned char hasLibArgs = 0; //Should we read something here? const char * tgmLibPath = "/system/lib/libhuawei-tgm.so"; int uevent_sock = -1; struct sockaddr_nl nladdr; int uevent_sz = 64 * 1024; LOGI("TGM Daemon version %d.%d", ver_major, ver_minor); system("mount -o rw -t usbfs none /proc/bus/usb"); // Socket to listen on for uevent changes memset(&nladdr, 0, sizeof(nladdr)); nladdr.nl_family = AF_NETLINK; nladdr.nl_pid = getpid(); nladdr.nl_groups = 0xffffffff; if ((uevent_sock = socket(PF_NETLINK, SOCK_DGRAM,NETLINK_KOBJECT_UEVENT)) < 0) { LOGE("Unable to create uevent socket: %s", strerror(errno)); exit(1); } if (setsockopt(uevent_sock, SOL_SOCKET, SO_RCVBUFFORCE, &uevent_sz, sizeof(uevent_sz)) < 0) { LOGE("Unable to set uevent socket options: %s", strerror(errno)); exit(1); } if (setsockopt(uevent_sock, SOL_SOCKET, SO_REUSEADDR, &uevent_sz, sizeof(uevent_sz)) < 0) { LOGE("Unable to set uevent socket options: %s", strerror(errno)); exit(1); } if (bind(uevent_sock, (struct sockaddr *) &nladdr, sizeof(nladdr)) < 0) { LOGE("Unable to bind uevent socket: %s", strerror(errno)); exit(1); } //OPEN LIBRARY dlHandle = dlopen(tgmLibPath, RTLD_NOW); if (dlHandle == NULL) { fprintf(stderr, "dlopen failed: %s\n", dlerror()); exit(-1); } TGM_startEventLoop(); tgmInit = (const TGM_RadioFunctions *(*)(const struct TGM_Env *, int, char **))dlsym(dlHandle, "TGM_Init"); if (tgmInit == NULL) { fprintf(stderr, "RIL_Init not defined or exported in %s\n", tgmLibPath); exit(-1); } funcs = tgmInit(&s_tgmEnv, argc, tgmArgv); TGM_register(funcs); while(1) { // sleep(UINT32_MAX) seems to return immediately on bionic //sleep(0x00ffffff); fd_set read_fds; struct timeval to; int max = 0; int rc = 0; to.tv_sec = (60 * 60); to.tv_usec = 0; FD_ZERO(&read_fds); FD_SET(uevent_sock, &read_fds); if (uevent_sock > max) max = uevent_sock; if ((rc = select(max + 1, &read_fds, NULL, NULL, &to)) < 0) { LOGE("select() failed (%s)", strerror(errno)); sleep(1); continue; } if (!rc) { continue; } if (FD_ISSET(uevent_sock, &read_fds)) { if ((rc = process_uevent_message(uevent_sock)) < 0) { LOGE("Error processing uevent msg (%s)", strerror(errno)); } } } return 0; }
void *usb_tty_monitor_thread(void *arg) { struct sockaddr_nl nladdr; struct pollfd pollfds[2]; int uevent_sock; int ret, max = 0; int uevent_sz = 64 * 1024; int timeout = -1; struct sigaction timeoutsigact; LOGE("3G modem monitor thread is start"); timeoutsigact.sa_handler = restart_rild; sigemptyset(&timeoutsigact.sa_mask); sigaddset(&timeoutsigact.sa_mask, SIGALRM); sigaction(SIGALRM, &timeoutsigact, 0); memset(&nladdr, 0, sizeof(nladdr)); nladdr.nl_family = AF_NETLINK; nladdr.nl_pid = getpid(); nladdr.nl_groups = 0xffffffff; uevent_sock = socket(PF_NETLINK, SOCK_DGRAM, NETLINK_KOBJECT_UEVENT); if (uevent_sock < 0) { LOGE(" Netlink socket faild, usb monitor exiting..."); return NULL; } if (setsockopt(uevent_sock, SOL_SOCKET, SO_RCVBUFFORCE, &uevent_sz, sizeof(uevent_sz)) < 0) { LOGE("Unable to set uevent socket options: %s", strerror(errno)); return NULL; } if (bind(uevent_sock, (struct sockaddr *) &nladdr, sizeof(nladdr)) < 0) { LOGE("Unable to bind uevent socket: %s", strerror(errno)); return NULL; } pollfds[0].fd = uevent_sock; pollfds[0].events = POLLIN; ret = fcntl(uevent_sock,F_SETFL, O_NONBLOCK); if (ret < 0) LOGE("Error on fcntl:%s", strerror(errno)); while (1) { ret = poll(pollfds, 1, timeout); switch (ret) { case 0: LOGD("poll timeout"); continue; case -1: LOGD("poll error:%s", strerror(errno)); break; default: if (pollfds[0].revents & POLLIN) process_uevent_message(uevent_sock); } } close(uevent_sock); }