CPP emuld: sync with public tizen
authorJinhyung Choi <jinhyung2.choi@samsung.com>
Thu, 7 Nov 2013 06:45:08 +0000 (15:45 +0900)
committerJinhyung Choi <jinhyung2.choi@samsung.com>
Thu, 7 Nov 2013 06:45:08 +0000 (15:45 +0900)
removed sys_event calls

Change-Id: I141af53601e314181c14c73ab9fd92c20e50112a
Signed-off-by: Jinhyung Choi <jinhyung2.choi@samsung.com>
20 files changed:
AUTHORS
CMakeLists.txt
emuld [new file with mode: 0644]
emuld.service [new file with mode: 0644]
include/emuld.h [changed mode: 0644->0755]
include/emuld_common.h [changed mode: 0644->0755]
include/emuld_proc.h [new file with mode: 0644]
include/evdi.h [new file with mode: 0644]
include/evdi_protocol.h [new file with mode: 0755]
include/log.h [new file with mode: 0644]
include/synbuf.h [new file with mode: 0755]
packaging/emuld.spec
src/client.cpp [new file with mode: 0644]
src/emuld.c [deleted file]
src/emuld.cpp [new file with mode: 0644]
src/emuld_proc.cpp [new file with mode: 0644]
src/evdi.cpp [new file with mode: 0644]
src/get_status.c [deleted file]
src/get_status.cpp [new file with mode: 0644]
src/log.cpp [new file with mode: 0644]

diff --git a/AUTHORS b/AUTHORS
index 978df0fb4e75ed284906848d0608eac95e4dcca4..3ba9fb3ba258c720da70e1648af7cd37c6c880cc 100644 (file)
--- a/AUTHORS
+++ b/AUTHORS
@@ -1,6 +1,7 @@
 YeongKyoon Lee <yeongkyoon.lee@samsung.com>
 DaiYoung Kim <daiyoung777.kim@samsung.com>
 SeokYeon Hwang <syeon.hwang@samsung.com>
+Jinhyung Choi <jinhyung2.choi@samsung.com>
 SangJin Kim <sangjin3.kim@samsung.com>
 KiTae Kim <kt920.kim@samsung.com>
 JinHyung Jo <jinhyung.jo@samsung.com>
index e958d0b3e0ab94ca5b0c1202107a0ce954fcf0f2..5e658f8d08584fec30f15d2d1edee22041d71d4b 100644 (file)
@@ -1,5 +1,5 @@
 cmake_minimum_required(VERSION 2.6)
-project(emuld C)
+project(emuld CXX)
 
 # to install pkgconfig setup file.
 SET(EXEC_PREFIX "\${prefix}")
@@ -34,7 +34,7 @@ ADD_DEFINITIONS("-DTARGET -DHWREV_CHECK")
 add_definitions(-Wall -O3 -omit-frame-pointer)
 #add_definitions(-Wall -g -D_DEBUG)
 add_definitions(-Iinclude)
-ADD_EXECUTABLE(${PROJECT_NAME} src/emuld.c src/get_status.c)
+ADD_EXECUTABLE(${PROJECT_NAME} src/emuld.cpp src/evdi.cpp src/emuld_proc.cpp src/client.cpp src/get_status.cpp src/log.cpp)
 
 target_link_libraries(${PROJECT_NAME} ${rpkgs_LDFLAGS} ${GLES_LDFLAGS})
 TARGET_LINK_LIBRARIES(${PROJECT_NAME} "-lpthread -lvconf" )
diff --git a/emuld b/emuld
new file mode 100644 (file)
index 0000000..7f13703
--- /dev/null
+++ b/emuld
@@ -0,0 +1,3 @@
+/usr/bin/emuld &
+/usr/sbin/sensord &
+/etc/emulator/sensor_setting.sh &
diff --git a/emuld.service b/emuld.service
new file mode 100644 (file)
index 0000000..1d9173f
--- /dev/null
@@ -0,0 +1,10 @@
+[Unit]
+Description=Daemon for emulator
+
+[Service]
+Type=simple
+ExecStart=/usr/bin/emuld
+
+[Install]
+WantedBy=emulator.target
+
old mode 100644 (file)
new mode 100755 (executable)
index 0e36146..4242721
  *
  */
 
+
+#ifndef __emuld_h__
+#define __emuld_h__
+
 /* header files */
 #include <stdio.h>
 #include <stdlib.h>
 #include <assert.h>
 #include <errno.h>
 #include <sys/mount.h>
+#include <stdbool.h>
+#include <fcntl.h>
+#include <queue>
+#include <map>
+
+#include "log.h"
+#include "emuld_common.h"
+#include "evdi_protocol.h"
+#include "evdi.h"
+#include "emuld_proc.h"
 
 /* definition */
 #define MAX_CLIENT             10000
 #define EMD_DEBUG
 #define POWEROFF_DURATION      2
 
-/* function prototype */
-void init_data0(void);            /* initialize data. */
-void init_server0(int svr_port);  /* server socket bind/listen */
-void* init_vm_connect(void* data);
-void epoll_init(void);            /* epoll fd create */
-void epoll_cli_add(int cli_fd);   /* client fd add to epoll set */
-void userpool_add(int cli_fd, unsigned short cli_port);
+
+#define SDB_PORT_FILE          "/opt/home/sdb_port.txt"
+
+enum
+{
+       fdtype_server = 0,
+       fdtype_device = 1,
+       fdtype_vmodem = 2,
+       fdtype_ij       = 3,
+       fdtype_sensor = 4, //udp
+       fdtype_max =5
+};
+
+extern pthread_t tid[MAX_CLIENT + 1];
+extern struct sockaddr_in si_sensord_other;
+extern int g_fd[fdtype_max];
+
+
+#define IJTYPE_TELEPHONY               "telephony"
+#define IJTYPE_SDCARD                  "sdcard"
+
+bool epoll_ctl_add(const int fd);
+
+void userpool_add(int cli_fd, unsigned short cli_port, const int fdtype);
 void userpool_delete(int cli_fd);
-int parse_val(char *buff, unsigned char data, char *parsbuf);
+
+
+bool epoll_init(void);            /* epoll fd create */
+bool epoll_ctl_add(const int fd);
+
+
+void init_data0(void);            /* initialize data. */
+bool init_server0(int svr_port, int* ret_fd);
+void end_server(int sig);
+
 void udp_init(void);
+void emuld_ready(void);
+
+bool server_process(void);
+bool accept_proc(const int server_fd);
+
 int recv_data(int event_fd, char** r_databuf, int size);
-void client_recv(int event_fd);
-void server_process(void);
-void end_server(int sig);
-int is_mounted(void);
+int parse_val(char *buff, unsigned char data, char *parsbuf);
+
+void set_vm_connect_status(const int v);
+bool is_vm_connected(void);
 
-static int log_print = -1;
-FILE* log_fd;
+void* init_vm_connect(void* data);
+
+
+
+
+void systemcall(const char* param);
+
+void recv_from_evdi(evdi_fd fd);
+
+static int log_print = 1;
 
+
+int powerdown_by_force(void);
 // location
 void setting_location(char* databuf);
 
+
 #define LOG(fmt, arg...) \
        do { \
                log_print_out("[%s:%d] "fmt"\n", __FUNCTION__, __LINE__, ##arg); \
        } while (0)
 
-inline void log_print_out(char *fmt, ...)
+
+
+
+#include <map>
+
+typedef unsigned short CliSN;
+
+struct Cli
 {
+       Cli(CliSN clisn, int fdtype, int fd, unsigned short port) :
+               clisn(clisn), fdtype(fdtype), sockfd(fd), cli_port(port) {}
+
+       CliSN clisn;
+       int fdtype;
+       int sockfd;                             /* client socket fds */
+       unsigned short cli_port;                /* client connection port */
+};
+
+typedef std::map<CliSN, Cli*> CliMap;
+
+
+void clipool_add(int fd, unsigned short port, const int fdtype);
+void clipool_delete(int fd);
+void close_cli(int cli_fd);
+
+Cli* find_cli(const int fd);
+bool send_to_cli(const int fd, char* data, const int len);
+bool send_to_all_ij(char* data, const int len);
+bool is_ij_exist();
+void stop_listen(void);
+
 
-#ifdef EMD_DEBUG
-       char *buf;
-
-       if(log_print == -1){
-               /* not initialized */
-               buf = getenv("EMULD_LOG");
-               if(buf != NULL){
-                       /* log print */
-                       fprintf(stdout, "env EMULD_LOG is set => print logs \n");
-                       log_print = 1;
-               }else{
-                       /* log not print */
-                       fprintf(stdout, "env EMULD_LOG is not set => Not print logs \n");
-                       log_print = 0;
+struct fd_info
+{
+       fd_info() : fd(-1){}
+       int fd;
+       int fdtype;
+};
+
+struct ijcommand
+{
+       enum { CMD_SIZE = 48 };
+       ijcommand() : data(NULL)
+       {
+               memset(cmd, 0, CMD_SIZE);
+       }
+       ~ijcommand()
+       {
+               if (data)
+               {
+                       free(data);
+                       data = NULL;
                }
        }
+       char cmd[CMD_SIZE];
+       char* data;
+       fd_info fdinfo;
 
-       if(log_print == 1){
-               char buf[4096]; 
-               va_list ap;
+       LXT_MESSAGE msg;
+};
 
-               va_start(ap, fmt);
-               vsnprintf(buf, sizeof(buf), fmt, ap);
-               va_end(ap);
+void process_evdi_command(ijcommand* ijcmd);
+bool read_ijcmd(const int fd, ijcommand* ijcmd);
 
-               fprintf(stdout, "%s", buf);
-               // for emuld log file
-               log_fd = fopen("/opt/sensor/emuld.log", "a"); 
-               fprintf(log_fd, "%s", buf);
-               fclose(log_fd);
-       }
+void* setting_device(void* data);
+
+// msg proc
+bool msgproc_telephony(const int sockfd, ijcommand* ijcmd, const bool is_evdi);
+bool msgproc_sensor(const int sockfd, ijcommand* ijcmd, const bool is_evdi);
+bool msgproc_location(const int sockfd, ijcommand* ijcmd, const bool is_evdi);
+bool msgproc_nfc(const int sockfd, ijcommand* ijcmd, const bool is_evdi);
+bool msgproc_system(const int sockfd, ijcommand* ijcmd, const bool is_evdi);
+bool msgproc_sdcard(const int sockfd, ijcommand* ijcmd, const bool is_evdi);
 
-#endif
 
-       return;
-}
+#endif //__emuld_h__
old mode 100644 (file)
new mode 100755 (executable)
index 5e96735..579e841
  *
  */
 
+
+#ifndef __emuld_common_h__
+#define __emuld_common_h__
+
+
 #include <stdio.h>
 #include <stdlib.h>
 #include <string.h>
@@ -32,6 +37,7 @@
 #include <errno.h>
 #include <netdb.h>
 #include <unistd.h>
+#include <pthread.h>
 
 // define group id
 // return value to the injector
 
 #define NFC_STATUS 121
 
+#define PATH_SENSOR_ACCEL_XYZ  "/sys/devices/virtual/sensor/accel/xyz"
+#define PATH_SENSOR_PROXI_VO   "/sys/devices/virtual/sensor/proxi/vo"
+#define PATH_SENSOR_LIGHT_ADC  "/sys/devices/virtual/sensor/light/adc"
+#define PATH_SENSOR_GYRO_X_RAW "/sys/devices/virtual/sensor/gyro/gyro_x_raw"
+#define PATH_SENSOR_GYRO_Y_RAW "/sys/devices/virtual/sensor/gyro/gyro_y_raw"
+#define PATH_SENSOR_GYRO_Z_RAW "/sys/devices/virtual/sensor/gyro/gyro_z_raw"
+#define PATH_SENSOR_GEO_TESLA  "/sys/devices/virtual/sensor/geo/tesla"
+#define PATH_NFC_DATA  "/sys/devices/virtual/network/nfc/data"
+
 struct LXT_MESSAGE// lxt_message
 {
        unsigned short length;
@@ -66,21 +81,39 @@ struct LXT_MESSAGE// lxt_message
 typedef struct LXT_MESSAGE LXT_MESSAGE;
 
 // Device
-char* get_battery_level(void* );
-char* get_battery_charger(void* );
-char* get_usb_status(void* );
-char* get_earjack_status(void* );
-char* get_rssi_level(void* );
+char* get_battery_level(void* , bool);
+char* get_battery_charger(void* , bool);
+char* get_usb_status(void* , bool);
+char* get_earjack_status(void* , bool);
+char* get_rssi_level(void* , bool);
 
 // Sensor
-char* get_proximity_status(void* );
-char* get_light_level(void* );
-char* get_acceleration_value(void* );
-char* get_gyroscope_value(void* );
-char* get_magnetic_value(void* );
+char* get_proximity_status(void* , bool);
+char* get_light_level(void* , bool);
+char* get_acceleration_value(void* , bool);
+char* get_gyroscope_value(void* , bool);
+char* get_magnetic_value(void* , bool);
 
 // Location
-char* get_location_status(void* );
+char* get_location_status(void* , bool);
 
 // NFC
-char* get_nfc_status(void* );
+char* get_nfc_status(void* , bool);
+
+struct _auto_mutex
+{
+       _auto_mutex(pthread_mutex_t* t)
+       {
+               _mutex = t;
+               pthread_mutex_lock(_mutex);
+
+       }
+       ~_auto_mutex()
+       {
+               pthread_mutex_unlock(_mutex);
+       }
+
+       pthread_mutex_t* _mutex;
+};
+
+#endif //
diff --git a/include/emuld_proc.h b/include/emuld_proc.h
new file mode 100644 (file)
index 0000000..3d423b9
--- /dev/null
@@ -0,0 +1,12 @@
+
+#ifndef __emuld_proc_h__
+#define __emuld_proc_h__
+
+
+int is_mounted(void);
+void* mount_sdcard(void* data);
+int umount_sdcard(const int fd);
+
+void send_guest_server(char* databuf);
+
+#endif
diff --git a/include/evdi.h b/include/evdi.h
new file mode 100644 (file)
index 0000000..29e0f24
--- /dev/null
@@ -0,0 +1,18 @@
+
+
+#ifndef __evdi_h__
+#define __evdi_h__
+
+typedef int            evdi_fd;
+
+bool init_device(evdi_fd* ret_fd);
+
+evdi_fd open_device(void);
+
+bool ijmsg_send_to_evdi(evdi_fd fd, const char* cat, const char* data, const int len);
+bool send_to_evdi(evdi_fd fd, const char* msg, const int len);
+bool msg_send_to_evdi(evdi_fd fd, const char* data, const int len);
+
+
+
+#endif
diff --git a/include/evdi_protocol.h b/include/evdi_protocol.h
new file mode 100755 (executable)
index 0000000..36f3d98
--- /dev/null
@@ -0,0 +1,38 @@
+/*\r
+ * evdi_protocol.h\r
+ *\r
+ *  Created on: 2013. 4. 15.\r
+ *      Author: dykim\r
+ */\r
+\r
+#ifndef EVDI_PROTOCOL_H_\r
+#define EVDI_PROTOCOL_H_\r
+\r
+/* device protocol */\r
+\r
+#define __MAX_BUF_SIZE 1024\r
+\r
+enum\r
+{\r
+       route_qemu = 0,\r
+       route_control_server = 1,\r
+       route_monitor = 2\r
+};\r
+\r
+typedef unsigned int CSCliSN;\r
+\r
+struct msg_info {\r
+       char buf[__MAX_BUF_SIZE];\r
+\r
+       uint32_t route;\r
+       uint32_t use;\r
+       uint16_t count;\r
+       uint16_t index;\r
+\r
+       CSCliSN cclisn;\r
+};\r
+\r
+/* device protocol */\r
+\r
+\r
+#endif /* EVDI_PROTOCOL_H_ */\r
diff --git a/include/log.h b/include/log.h
new file mode 100644 (file)
index 0000000..1135171
--- /dev/null
@@ -0,0 +1,11 @@
+
+#ifndef __log_h__
+#define __log_h__
+
+
+void make_timestamp(char* ret);
+void log_print_out(const char *fmt, ...);
+
+
+
+#endif
diff --git a/include/synbuf.h b/include/synbuf.h
new file mode 100755 (executable)
index 0000000..bb79751
--- /dev/null
@@ -0,0 +1,135 @@
+/*\r
+ * synbuf.h\r
+ *\r
+ *  Created on: 2013. 4. 12.\r
+ *      Author: dykim\r
+ */\r
+\r
+#ifndef SYNBUF_H_\r
+#define SYNBUF_H_\r
+\r
+#include <stdbool.h>\r
+\r
+\r
+class synbuf\r
+{\r
+public:\r
+\r
+       enum\r
+       {\r
+               default_buf_size = 2048\r
+       };\r
+       synbuf()\r
+               : m_buf(NULL), m_size(default_buf_size), m_use(0)\r
+       {\r
+               m_buf = (char*) malloc(default_buf_size);\r
+               memset(m_buf, 0, default_buf_size);\r
+               m_readptr = m_buf;\r
+       }\r
+\r
+       void reset_buf()\r
+       {\r
+               freebuf();\r
+\r
+               m_buf = (char*) malloc(default_buf_size);\r
+               memset(m_buf, 0, default_buf_size);\r
+               m_readptr = m_buf;\r
+\r
+               m_size = default_buf_size;\r
+               m_use = 0;\r
+       }\r
+\r
+       int available()\r
+       {\r
+               return m_size - m_use;\r
+       }\r
+\r
+       char* get_readptr()\r
+       {\r
+               return m_readptr;\r
+       }\r
+\r
+       void set_written(const int written)\r
+       {\r
+               m_use += written;\r
+       }\r
+\r
+       void freebuf()\r
+       {\r
+               if (m_buf)\r
+               {\r
+                       free(m_buf);\r
+                       m_buf = NULL;\r
+               }\r
+       }\r
+\r
+       bool realloc_and_move(const int newsize, const int readed)\r
+       {\r
+               char* tmp = (char*) malloc(newsize);\r
+               if (!tmp)\r
+                       return false;\r
+\r
+               int left = m_use - readed;\r
+               memset(tmp, 0, newsize);\r
+               memcpy(tmp, m_buf + readed, left);\r
+\r
+               freebuf();\r
+\r
+               m_buf = tmp;\r
+               m_use = left;\r
+               m_size = newsize;\r
+               m_readptr = m_buf;\r
+\r
+               return true;\r
+       }\r
+\r
+       bool write(const char* buf, const int len)\r
+       {\r
+               if (len >= available())\r
+               {\r
+                       if (!realloc_and_move((m_size * 2), 0))\r
+                               return false;\r
+               }\r
+\r
+               memcpy(m_buf + m_use, buf, len);\r
+               m_use += len;\r
+\r
+               return true;\r
+       }\r
+\r
+       int read(char* buf, const int len)\r
+       {\r
+               if (m_use < len)\r
+                       return 0;\r
+\r
+               memcpy(buf, m_buf, len);\r
+\r
+               int left = m_use - len;\r
+               if (left > 0)\r
+               {\r
+                       realloc_and_move(m_size, len);\r
+               }\r
+               else\r
+               {\r
+                       // there is no more readable buffer, reset all variables\r
+                       memset(m_buf, 0, m_size);\r
+                       m_readptr = m_buf;\r
+                       m_use = 0;\r
+               }\r
+\r
+               return len;\r
+       }\r
+\r
+\r
+private:\r
+\r
+\r
+       char* m_buf;\r
+       char* m_readptr;\r
+       int m_size;\r
+       int m_use;\r
+};\r
+\r
+\r
+\r
+#endif /* SYNBUF_H_ */\r
index 91eb62036632d9e27e9f9116bba52623a87890f1..19d52cca15724092f42a03351b322c56f403b608 100644 (file)
@@ -1,6 +1,6 @@
 #git:/slp/pkgs/e/emulator-daemon
 Name: emuld
-Version: 0.2.27
+Version: 0.2.29
 Release: 1
 Summary: emuld is used for communication emulator between and ide.
 License: Apache
@@ -25,6 +25,24 @@ make
 
 %install
 rm -rf %{buildroot}
+
+#for systemd
+if [ ! -d %{buildroot}/usr/lib/systemd/system/emulator.target.wants ]; then
+    mkdir -p %{buildroot}/usr/lib/systemd/system/emulator.target.wants
+fi
+cp emuld.service %{buildroot}/usr/lib/systemd/system/.
+ln -s ../emuld.service %{buildroot}/usr/lib/systemd/system/emulator.target.wants/emuld.service
+
+#for legacy init
+if [ ! -d %{buildroot}/etc/init.d ]; then
+    mkdir -p %{buildroot}/etc/init.d
+fi
+cp emuld %{buildroot}/etc/init.d/.
+if [ ! -d %{buildroot}/etc/rc.d/rc3.d ]; then
+    mkdir -p %{buildroot}/etc/rc.d/rc3.d
+fi
+ln -s /etc/init.d/emuld %{buildroot}/etc/rc.d/rc3.d/S04emuld
+
 %make_install
 
 %clean
@@ -38,12 +56,15 @@ rm -rf install_manifes.txt
 %post
 chmod 777 /usr/bin/emuld
 mkdir -p /opt/nfc
-touch /opt/nfc/sdkMsg
 
 %postun
 
 %files
 %defattr(-,root,root,-)
 %{_prefix}/bin/emuld
+/usr/lib/systemd/system/emuld.service
+/usr/lib/systemd/system/emulator.target.wants/emuld.service
+/etc/init.d/emuld
+/etc/rc.d/rc3.d/S04emuld
 
 %changelog
diff --git a/src/client.cpp b/src/client.cpp
new file mode 100644 (file)
index 0000000..876771c
--- /dev/null
@@ -0,0 +1,129 @@
+\r
+\r
+#include "emuld.h"\r
+#include "emuld_common.h"\r
+\r
+static pthread_mutex_t mutex_climap = PTHREAD_MUTEX_INITIALIZER;\r
+\r
+\r
+CliMap g_climap;\r
+\r
+void clipool_add(int fd, unsigned short port, const int fdtype)\r
+{\r
+       _auto_mutex _(&mutex_climap);\r
+\r
+       static CliSN s_id = 0;\r
+\r
+       CliSN id = s_id;\r
+       s_id++;\r
+       Cli* cli = new Cli(id, fdtype, fd, port);\r
+       if (!cli)\r
+               return;\r
+\r
+       if (!g_climap.insert(CliMap::value_type(fd, cli)).second)\r
+               return;\r
+\r
+       LOG("clipool_add fd = %d, port = %d, type = %d \n", fd, port, fdtype);\r
+}\r
+\r
+\r
+void close_cli(int cli_fd)\r
+{\r
+       clipool_delete(cli_fd);\r
+       close(cli_fd);\r
+}\r
+\r
+void clipool_delete(int fd)\r
+{\r
+       _auto_mutex _(&mutex_climap);\r
+\r
+       CliMap::iterator it = g_climap.find(fd);\r
+\r
+       if (it != g_climap.end())\r
+       {\r
+               Cli* cli = it->second;\r
+               g_climap.erase(it);\r
+\r
+               if (cli)\r
+               {\r
+                       delete cli;\r
+                       cli = NULL;\r
+               }\r
+       }\r
+\r
+       LOG("clipool_delete fd = %d\n", fd);\r
+}\r
+\r
+\r
+Cli* find_cli(const int fd)\r
+{\r
+       _auto_mutex _(&mutex_climap);\r
+\r
+       CliMap::iterator it = g_climap.find(fd);\r
+       if (it != g_climap.end())\r
+               return NULL;\r
+\r
+       Cli* cli = it->second;\r
+       return cli;\r
+}\r
+\r
+// for thread safe\r
+bool send_to_cli(const int fd, char* data, const int len)\r
+{\r
+       _auto_mutex _(&mutex_climap);\r
+\r
+       CliMap::iterator it = g_climap.find(fd);\r
+       if (it == g_climap.end())\r
+               return false;\r
+\r
+       Cli* cli = it->second;\r
+\r
+       if (send(cli->sockfd, data, len, 0) == -1)\r
+               return false;\r
+\r
+       return true;\r
+}\r
+\r
+bool send_to_all_ij(char* data, const int len)\r
+{\r
+       _auto_mutex _(&mutex_climap);\r
+\r
+       bool result = false;\r
+       CliMap::iterator it, itend = g_climap.end();\r
+\r
+       for (it = g_climap.begin(); it != itend; it++)\r
+       {\r
+               Cli* cli = it->second;\r
+\r
+               if (!cli)\r
+                       continue;\r
+\r
+               int sent = send(cli->sockfd, data, len, 0);\r
+               result = (sent == -1) ? false : true;\r
+               if (sent == -1)\r
+               {\r
+                       perror("failed to send to ij\n");\r
+               }\r
+\r
+               LOG("send_len: %d, err= %d\n", sent, errno);\r
+       }\r
+       return result;\r
+}\r
+\r
+bool is_ij_exist()\r
+{\r
+       _auto_mutex _(&mutex_climap);\r
+\r
+       bool result = (g_climap.size() > 0) ? true : false;\r
+       return result;\r
+}\r
+\r
+void stop_listen(void)\r
+{\r
+       pthread_mutex_destroy(&mutex_climap);;\r
+}\r
+\r
+\r
+\r
+\r
+\r
diff --git a/src/emuld.c b/src/emuld.c
deleted file mode 100644 (file)
index b2e6fe9..0000000
+++ /dev/null
@@ -1,1354 +0,0 @@
-/* -*- Mode: C; c-basic-offset: 8; indent-tabs-mode: t -*-
- * emulator-daemon
- *
- * Copyright (c) 2000 - 2011 Samsung Electronics Co., Ltd. All rights reserved.
- *
- * Contact:
- * SooYoung Ha <yoosah.ha@samsnung.com>
- * Sungmin Ha <sungmin82.ha@samsung.com>
- * YeongKyoon Lee <yeongkyoon.lee@samsung.com>
- * 
- * Licensed under the Apache License, Version 2.0 (the "License");
- * you may not use this file except in compliance with the License.
- * You may obtain a copy of the License at
- *
- * http://www.apache.org/licenses/LICENSE-2.0
- *
- * Unless required by applicable law or agreed to in writing, software
- * distributed under the License is distributed on an "AS IS" BASIS,
- * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
- * See the License for the specific language governing permissions and
- * limitations under the License.
- * 
- * Contributors:
- * - S-Core Co., Ltd
- *
- */
-
-/*-----------------------------------------------------------------
-
-epoll server program by Sungmin Ha.
-Platform : Linux 2.6.x (kernel)
-compiler Gcc: 3.4.3. 
-License: GNU General Public License   
-
-------------------------------------------------------------------*/
-#include "emuld_common.h"
-#include "emuld.h"
-
-/* global definition */
-unsigned short sdbd_port = SDBD_PORT;
-unsigned short vmodem_port = VMODEM_PORT;
-unsigned short gpsd_port = GPSD_PORT;
-unsigned short sensord_port = SENSORD_PORT;
-
-int g_svr_sockfd;                      /* global server socket fd */
-int g_svr_port;                        /* global server port number */
-int g_vm_sockfd;               /* vmodem fd */
-int g_sdbd_sockfd = -1;                /* sdbd fd */
-static int g_vm_connect_status;        /* connection status between emuld and vmodem  */
-int g_sdcard_sockfd = -1;
-int g_get_status_sockfd = -1;   /* return status of devive to the injector */
-
-pthread_t tid[MAX_CLIENT + 1];
-
-static struct timeval tv_start_poweroff;
-
-/* udp socket */
-struct sockaddr_in si_sensord_other, si_gpsd_other;
-int uSensordFd, uGpsdFd, sslen=sizeof(si_sensord_other), sglen=sizeof(si_gpsd_other);
-
-struct {
-       int  cli_sockfd;                                /* client socket fds */
-       unsigned short cli_port;              /* client connection port */
-} g_client[MAX_CLIENT];
-
-int g_epoll_fd;                                /* epoll fd */
-
-struct epoll_event g_events[MAX_EVENTS]; 
-
-void TAPIMessageInit(LXT_MESSAGE *packet)
-{       
-       packet->length = 0;
-       packet->group = 0;
-       packet->action = 0;
-       packet->data = 0;
-}
-
-char SDpath[256];
-
-unsigned char ActionID = 0;
-char GetBuffer[256];
-void setting_device(); 
-/*--------------------------------------------------------------*/
-/* FUNCTION PART 
-   ---------------------------------------------------------------*/
-/*---------------------------------------------------------------
-function : init_data0
-io: none
-desc: initialize global client structure values
-----------------------------------------------------------------*/
-void init_data0(void)
-{
-       register int i;
-
-       for(i = 0 ; i < MAX_CLIENT ; i++) {
-               g_client[i].cli_sockfd = -1;
-       }
-}
-
-/*------------------------------------------------------------- 
-function: init_server0 
-io: input : integer - server port (must be positive)
-output: none
-desc : tcp/ip listening socket setting with input variable
-----------------------------------------------------------------*/
-
-void init_server0(int svr_port)
-{
-       struct sockaddr_in serv_addr;
-
-       /* Open TCP Socket */
-       if( (g_svr_sockfd = socket(AF_INET,SOCK_STREAM,0)) < 0 ) 
-       {
-               fprintf(stderr, "Server Start Fails. : Can't open stream socket \n");
-               exit(0);
-       }
-
-       /* Address Setting */
-       memset( &serv_addr , 0 , sizeof(serv_addr)) ; 
-
-       serv_addr.sin_family = AF_INET;
-       serv_addr.sin_addr.s_addr = htonl(INADDR_ANY);
-       serv_addr.sin_port = htons(svr_port);
-
-       /* Set Socket Option  */
-       int nSocketOpt = 1;
-       if( setsockopt(g_svr_sockfd, SOL_SOCKET, SO_REUSEADDR, &nSocketOpt, sizeof(nSocketOpt)) < 0 )
-       {
-               fprintf(stderr, "Server Start Fails. : Can't set reuse address\n");
-               close(g_svr_sockfd); 
-               exit(0);
-       }
-
-       /* Bind Socket */
-       if(bind(g_svr_sockfd,(struct sockaddr *)&serv_addr, sizeof(serv_addr)) < 0)
-       {
-               fprintf(stderr, "Server Start Fails. : Can't bind local address\n");
-               close(g_svr_sockfd);
-               exit(0);
-       }
-
-       /* Listening */
-       listen(g_svr_sockfd,15); /* connection queue is 15. */
-
-       LOG("[START] Now Server listening on port %d, EMdsockfd: %d"
-                       ,svr_port, g_svr_sockfd);
-} 
-/*------------------------------- end of function init_server0 */
-
-void* init_vm_connect(void* data)
-{
-       struct sockaddr_in vm_addr;
-       int ret = -1;   
-       g_vm_connect_status = 0;
-
-       LOG("start");
-
-       pthread_detach(pthread_self());
-       /* Open TCP Socket */
-       if( (g_vm_sockfd = socket(AF_INET,SOCK_STREAM,0)) < 0 ) 
-       {
-               fprintf(stderr, "Server Start Fails. : Can't open stream socket \n");
-               exit(0);
-       }
-
-       /* Address Setting */
-       memset( &vm_addr , 0 , sizeof(vm_addr)) ; 
-
-       vm_addr.sin_family = AF_INET;
-       vm_addr.sin_addr.s_addr = inet_addr("127.0.0.1");
-       vm_addr.sin_port = htons(vmodem_port);
-
-       while(ret < 0)
-       {
-               ret = connect(g_vm_sockfd, (struct sockaddr *)&vm_addr, sizeof(vm_addr));
-
-               LOG("vm_sockfd: %d, connect ret: %d", g_vm_sockfd, ret);
-
-               if(ret < 0) {
-                       LOG("connection failed to vmodem!");            
-                       sleep(1);
-               }
-       }
-       
-       userpool_add(g_vm_sockfd, vm_addr.sin_port);
-
-       /* add client sockfd at event pool */
-       epoll_cli_add(g_vm_sockfd);
-       
-       g_vm_connect_status = 1;
-       pthread_exit((void *) 0); 
-}
-
-int is_mounted()
-{
-       int ret = -1, i = 0;
-       struct stat buf;
-       char file_name[128];
-       memset(file_name, '\0', sizeof(file_name));
-
-       for(i = 0; i < 10; i++)
-       {
-               sprintf(file_name, "/dev/emul_mmcblk%d", i);
-               ret = access( file_name, F_OK );
-               if( ret == 0 )
-               {
-                       lstat(file_name, &buf);
-                       if(S_ISBLK(buf.st_mode))
-                               return 1;
-                       else
-                               return 0;
-               }
-       }
-
-       return 0;
-}
-
-void* mount_sdcard(void* data)
-{
-       int ret = -1, i = 0, vconf_value = -1;  
-       struct stat buf;
-       char file_name[128], command[256];
-       memset(file_name, '\0', sizeof(file_name));
-       memset(command, '\0', sizeof(command));
-
-       LXT_MESSAGE* packet = (LXT_MESSAGE*)malloc(sizeof(LXT_MESSAGE));
-       memset(packet, 0, sizeof(LXT_MESSAGE));
-
-       LOG("start sdcard mount thread");
-
-       pthread_detach(pthread_self());
-
-       while(ret < 0)
-       {       
-               for(i = 0; i < 10; i++)
-               {
-                       sprintf(file_name, "/dev/emul_mmcblk%d", i);
-                       ret = access( file_name, F_OK );
-                       if( ret == 0 )
-                       {
-                               lstat(file_name, &buf);
-                               if(!S_ISBLK(buf.st_mode))
-                               {
-                                       sprintf(command, "rm -rf %s", file_name);
-                                       system(command);
-                               }
-                               else
-                                       break;
-                       }
-               }
-
-               if( i != 10 )
-               {
-                       LOG( "%s is exist", file_name);
-                       ret = mount(file_name, "/mnt/mmc", "ext3", 0, "");
-                       LOG("mount ret = %d, errno = %d", ret, errno);
-                       
-                       LOG("sdcard fd: %d", g_sdcard_sockfd);
-                       if(g_sdcard_sockfd != -1)
-                       {
-                               packet->length = strlen(SDpath);                // length
-                               packet->group = 11;                             // sdcard
-                               if(ret == 0)
-                                       packet->action = 1;     // mounted
-                               else
-                                       packet->action = 5;     // failed
-
-                               send(g_sdcard_sockfd, (void*)packet, sizeof(char) * HEADER_SIZE, 0);
-                               LOG("SDpath is %s", SDpath);
-                               send(g_sdcard_sockfd, SDpath, packet->length, 0);
-                               
-                               if(ret == 0)
-                               {
-                                       system("chmod -R 777 /opt/storage/sdcard");
-                                       system("vconftool set -t int memory/sysman/mmc 1 -i -f");
-                               }
-                       }
-
-                       break;
-               }
-               else
-               {
-                       LOG( "%s is not exist", file_name);
-                       sleep(1);       
-               }               
-       }
-
-       pthread_exit((void *) 0); 
-} 
-
-int umount_sdcard(void)
-{
-       int ret = -1, i = 0;    
-       char file_name[128];
-       memset(file_name, '\0', sizeof(file_name));
-       LXT_MESSAGE* packet = (LXT_MESSAGE*)malloc(sizeof(LXT_MESSAGE));
-       if(packet == NULL){
-           return ret;
-       }
-       memset(packet, 0, sizeof(LXT_MESSAGE));
-
-       LOG("start sdcard umount");
-
-       pthread_cancel(tid[1]);
-
-       for(i = 0; i < 10; i++)
-       {
-               sprintf(file_name, "/dev/emul_mmcblk%d", i);
-               ret = access( file_name, F_OK);
-               if ( ret == 0 )
-               {
-                       LOG( "%s is exist", file_name);
-                       ret = umount("/mnt/mmc");
-                       LOG("umount ret = %d, errno = %d", ret, errno);
-                       
-                       LOG("sdcard fd: %d", g_sdcard_sockfd);
-                       if(g_sdcard_sockfd != -1)
-                       {
-                               packet->length = strlen(SDpath);                // length
-                               packet->group = 11;                             // sdcard
-                               if(ret == 0)
-                                       packet->action = 0;                             // unmounted
-                               else
-                                       packet->action = 4;                             // failed
-
-                               send(g_sdcard_sockfd, (void*)packet, sizeof(char) * HEADER_SIZE, 0);
-                               LOG("SDpath is %s", SDpath);
-                               send(g_sdcard_sockfd, SDpath, packet->length, 0);
-                               
-                               if(ret == 0)
-                               {
-                                       memset(SDpath, '\0', sizeof(SDpath));
-                                       sprintf(SDpath, "umounted");
-                                       system("vconftool set -t int memory/sysman/mmc 0 -i -f");
-                               }                               
-                       }
-
-                       break;
-               }
-               else
-               {
-                       LOG( "%s is not exist", file_name);
-               }
-       }
-
-       if(packet){
-           free(packet);
-           packet = NULL;
-       }
-       return ret;
-} 
-
-void epoll_init(void)
-{
-       struct epoll_event events;
-
-       g_epoll_fd = epoll_create(MAX_EVENTS); // create event pool
-       if(g_epoll_fd < 0)
-       {
-               fprintf(stderr, "Epoll create Fails.\n");
-               close(g_svr_sockfd);
-               exit(0);
-       }
-
-       LOG("[START] epoll creation success");
-
-       /* event control set */
-       events.events = EPOLLIN;        // check In event
-       events.data.fd = g_svr_sockfd;
-
-       /* server events set(read for accept) */
-       // add sockfd at event pool
-       if( epoll_ctl(g_epoll_fd, EPOLL_CTL_ADD, g_svr_sockfd, &events) < 0 )
-       {
-               fprintf(stderr, "Epoll control fails.\n");
-               close(g_svr_sockfd);
-               close(g_epoll_fd);
-               exit(0);
-       }
-
-       LOG("[START] epoll events set success for server");
-}
-/*------------------------------- end of function epoll_init */
-
-void epoll_cli_add(int cli_fd)
-{
-       struct epoll_event events;
-
-       /* event control set for read event */
-       events.events = EPOLLIN;
-       events.data.fd = cli_fd; 
-
-       if( epoll_ctl(g_epoll_fd, EPOLL_CTL_ADD, cli_fd, &events) < 0 )
-       {
-               LOG("Epoll control fails.in epoll_cli_add");
-       }
-}
-
-void userpool_add(int cli_fd, unsigned short cli_port)
-{
-       /* get empty element */
-       register int i;
-
-       for( i = 0 ; i < MAX_CLIENT ; i++ )
-       {
-               if(g_client[i].cli_sockfd == -1) break;
-       }
-       if( i >= MAX_CLIENT ){ 
-           close(cli_fd);
-           return;
-       }
-
-       LOG("g_client[%d].cli_port: %d", i, cli_port);
-
-       g_client[i].cli_sockfd = cli_fd;
-       g_client[i].cli_port = cli_port;
-}
-
-void userpool_delete(int cli_fd)
-{
-       register int i;
-
-       for( i = 0 ; i < MAX_CLIENT ; i++)
-       {
-               if(g_client[i].cli_sockfd == cli_fd)
-               {
-                       g_client[i].cli_sockfd = -1;    
-                       break;
-               }
-       }
-}
-
-int parse_val(char *buff, unsigned char data, char *parsbuf)
-{
-       int count=0;
-       while(1)
-       {
-               if(count > 40)
-                       return -1;
-               if(buff[count] == data)
-               {
-                       count++;
-                       strncpy(parsbuf, buff, count);
-                       return count;
-               }
-               count++;
-       }
-
-       return 0;
-}
-
-#define STR_HELPER(x) #x
-#define STR(x) STR_HELPER(x)
-
-void udp_init(void)
-{
-       char emul_ip[HOST_NAME_MAX+1];
-       struct addrinfo *res;
-       struct addrinfo hints;
-       int rc;
-
-       LOG("start");
-
-       memset(emul_ip, 0, sizeof(emul_ip));
-       if (gethostname(emul_ip, sizeof(emul_ip)) < 0)
-       {
-               LOG("gethostname(): %s", strerror(errno));
-               assert(0);
-       }
-
-       memset(&hints, 0, sizeof(hints));
-       hints.ai_family=AF_INET;
-       hints.ai_socktype=SOCK_DGRAM;
-       hints.ai_protocol=IPPROTO_UDP;
-
-       if ((rc=getaddrinfo(emul_ip, STR(SENSORD_PORT), &hints, &res)) != 0)
-       {
-               if (rc == EAI_SYSTEM)
-                       LOG("getaddrinfo(sensord): %s", strerror(errno));
-               else
-                       LOG("getaddrinfo(sensord): %s", gai_strerror(rc));
-               assert(0);
-       }
-
-       if ((uSensordFd=socket(res->ai_family, res->ai_socktype, res->ai_protocol))==-1){
-               fprintf(stderr, "socket error!\n");
-       }
-
-       if (res->ai_addrlen > sizeof(si_sensord_other))
-       {
-               LOG("sockaddr structure too big");
-               /* XXX: if you `return' remember to clean up */
-               assert(0);
-       }
-       memset((char *) &si_sensord_other, 0, sizeof(si_sensord_other));
-       memcpy((char *) &si_sensord_other, res->ai_addr, res->ai_addrlen);
-       freeaddrinfo(res);
-
-       if ((rc=getaddrinfo(emul_ip, STR(GPSD_PORT), &hints, &res)) != 0)
-       {
-               if (rc == EAI_SYSTEM)
-                       LOG("getaddrinfo(gpsd): %s", strerror(errno));
-               else
-                       LOG("getaddrinfo(gpsd): %s", gai_strerror(rc));
-               assert(0);
-       }
-
-       if ((uGpsdFd=socket(res->ai_family, res->ai_socktype, res->ai_protocol))==-1){
-               fprintf(stderr, "socket error!\n");
-       }
-
-       if (res->ai_addrlen > sizeof(si_gpsd_other))
-       {
-               LOG("sockaddr structure too big");
-               assert(0);
-       }
-       memset((char *) &si_gpsd_other, 0, sizeof(si_gpsd_other));
-       memcpy((char *) &si_gpsd_other, res->ai_addr, res->ai_addrlen);
-       freeaddrinfo(res);
-}
-
-#undef STR_HELPER
-#undef STR
-
-int recv_data(int event_fd, char** r_databuf, int size)
-{
-       int recvd_size = 0;
-       int len = 0;
-       int getcnt = 0;
-       char* r_tmpbuf = NULL;
-
-       r_tmpbuf = (char*)malloc(sizeof(char) * size + 1);
-       if(r_tmpbuf == NULL){
-           return -1;
-       }
-
-       *r_databuf = (char*)malloc(sizeof(char) * size + 1);
-       if(*r_databuf == NULL){
-           free(r_tmpbuf);
-           return -1;
-       }
-       memset(*r_databuf, '\0', sizeof(char) * size + 1);
-
-       while(recvd_size < size)
-       {
-               memset(r_tmpbuf, '\0', sizeof(char) * size + 1);
-               len = recv(event_fd, r_tmpbuf, size - recvd_size, 0);
-               if (len < 0) {
-                       break;
-               }
-
-               memcpy((*r_databuf) + recvd_size, r_tmpbuf, len);
-               recvd_size += len;
-               getcnt++;
-               if(getcnt > MAX_GETCNT) {
-                       break;
-               }
-       }
-       free(r_tmpbuf);
-       r_tmpbuf = NULL;
-
-       return recvd_size;
-}
-
-int powerdown_by_force()
-{
-       struct timeval now;
-       int poweroff_duration = POWEROFF_DURATION;
-       char *buf;
-
-       /* Getting poweroff duration */
-       buf = getenv("PWROFF_DUR");
-       if(buf == NULL)
-       {
-               LOG("PWROFF_DUR is null");
-               assert(0);
-       }
-       
-       if (strlen(buf) < 1024)
-               poweroff_duration = atoi(buf);
-       if (poweroff_duration < 0 || poweroff_duration > 60) 
-               poweroff_duration = POWEROFF_DURATION;
-
-       gettimeofday(&now, NULL);
-       /* Waiting until power off duration and displaying animation */
-       while (now.tv_sec - tv_start_poweroff.tv_sec < poweroff_duration) {
-               LOG("wait");
-               usleep(100000);
-               gettimeofday(&now, NULL);
-       }   
-
-       LOG("Power off by force");
-       LOG("sync");
-       sync();
-       LOG("poweroff");
-       reboot(RB_POWER_OFF);
-
-       return 1;
-}
-
-void client_recv(int event_fd)
-{
-       char* r_databuf = NULL;
-       char tmpbuf[48];
-       int len, recvd_size, parse_len = 0;
-       LXT_MESSAGE* packet = (LXT_MESSAGE*)malloc(sizeof(LXT_MESSAGE));
-       if (packet == NULL)
-       {
-           return;
-       }
-       memset(packet, 0, sizeof(LXT_MESSAGE));
-
-       LOG("start (event fd: %d)", event_fd);
-       /* there need to be more precise code here */ 
-       /* for example , packet check(protocol needed) , real recv size check , etc. */
-       if (event_fd == -1) {
-               free(packet);
-               packet = NULL;
-               return;
-       }
-
-       // vmodem to event injector
-       if(event_fd == g_vm_sockfd)
-       {       
-               recvd_size = recv_data(event_fd, &r_databuf, HEADER_SIZE);
-               LOG("receive size: %d", recvd_size);
-               if(recvd_size <= 0)
-               {
-                       free(r_databuf);
-                       r_databuf = NULL;
-                       free(packet);
-                       packet = NULL;
-                       userpool_delete(event_fd);
-                       close(event_fd); /* epoll set fd also deleted automatically by this call as a spec */
-                       if(pthread_create(&tid[0], NULL, init_vm_connect, NULL) != 0)
-                               LOG("pthread create fail!");
-                       return;
-               }
-
-               LOG("vmodem header recv buffer: %s", r_databuf);
-               memcpy((void*)packet, (void*)r_databuf, sizeof(char) * HEADER_SIZE);
-
-               LOG("first packet of vmodem to event injector %s", r_databuf);
-               free(r_databuf);
-               r_databuf = NULL;
-               
-               if(g_sdbd_sockfd != -1)
-                       len = send(g_sdbd_sockfd, (void*)packet, sizeof(char) * HEADER_SIZE, 0);
-               else {
-                       free(packet);
-                       packet = NULL;
-                       return;
-               }
-
-               LOG("send_len: %d, next packet length: %d", len, packet->length);
-
-               if(packet->length <= 0)
-               {
-                       free(packet);
-                       packet = NULL;
-                       return;
-               }       
-                       
-               if(g_sdbd_sockfd != -1)
-                       recvd_size = recv_data(event_fd, &r_databuf, packet->length);
-               else
-               {
-                       // for packet clear
-                       recvd_size = recv_data(event_fd, &r_databuf, packet->length);
-                       return;
-               }
-
-               LOG("recv_len: %d, vmodem data recv buffer: %s", recvd_size, r_databuf);
-
-               if(recvd_size <= 0)
-               {
-                       free(r_databuf);
-                       r_databuf = NULL;
-                       free(packet);
-                       packet = NULL;
-                       return;
-               }
-               len = send(g_sdbd_sockfd, r_databuf, packet->length, 0);
-
-               LOG("send_len: %d", len);
-       }
-       else    // event injector to vmodem, sensord or gpsd
-       {
-               /* read from socket */
-               // read identifier
-               recvd_size = recv_data(event_fd, &r_databuf, ID_SIZE);
-               LOG("receive size: %d", recvd_size);
-               if( recvd_size <= 0 )
-               {
-                       free(r_databuf);
-                       r_databuf = NULL;
-                       free(packet);
-                       packet = NULL;
-                       LOG("close event_fd: %d", event_fd);
-                       userpool_delete(event_fd);
-                       close(event_fd); /* epoll set fd also deleted automatically by this call as a spec */
-                       if(event_fd == g_sdbd_sockfd)
-                               g_sdbd_sockfd = -1;
-
-                       return;
-               }
-
-               LOG("Something may be added in the data end, but it does not matter.");
-               LOG("identifier: %s", r_databuf);
-
-               memset(tmpbuf, '\0', sizeof(tmpbuf));
-               parse_len = parse_val(r_databuf, 0x0a, tmpbuf);
-
-               LOG("parse_len: %d", parse_len);
-               LOG("parsed_buffer: %s", tmpbuf);
-               LOG("event fd: %d", event_fd);
-
-               free(r_databuf);
-               r_databuf = NULL;
-
-               if(strncmp(tmpbuf, "telephony", 9) == 0)
-               {
-                       g_sdbd_sockfd = event_fd;
-                       if(g_vm_connect_status != 1) {  // The connection is lost with vmodem
-                               free(packet);
-                               packet = NULL;
-                               return;
-                       }
-
-                       recvd_size = recv_data(event_fd, &r_databuf, HEADER_SIZE);                      
-                       len = send(g_vm_sockfd, r_databuf, HEADER_SIZE, 0);
-                       
-                       memcpy((void*)packet, (void*)r_databuf, HEADER_SIZE);
-
-                       LOG("next packet length: %d", packet->length);
-                       LOG("packet->action: %d", packet->action);
-
-                       free(r_databuf);
-                       r_databuf = NULL;
-
-                       if(packet->length == 0)
-                       {       
-                               if(packet->action == 71)        // that's strange packet from telephony initialize
-                               {
-                                       packet->length = 4;
-                               }
-                               else
-                               {
-                                       free(packet);
-                                       packet = NULL;
-                                       return;
-                               }
-                       }                               
-
-                       if(g_vm_connect_status != 1)    // The connection is lost with vmodem
-                               return;
-
-                       recvd_size = recv_data(event_fd, &r_databuf, packet->length);
-
-                       if(recvd_size <= 0)
-                       {
-                               free(r_databuf);
-                               r_databuf = NULL;                               
-                               free(packet);
-                               packet = NULL;
-                               return;
-                       } else {
-                               LOG("Something may be added in the data end, but it does not matter.");
-                               LOG("telephony data recv buffer: %s", r_databuf);
-
-                               len = send(g_vm_sockfd, r_databuf, packet->length, 0);
-                       }
-               }
-               else if(strncmp(tmpbuf, "sensor", 6) == 0)
-               {
-                       recvd_size = recv_data(event_fd, &r_databuf, HEADER_SIZE);
-                       memcpy((void*)packet, (void*)r_databuf, HEADER_SIZE);   
-
-                       LOG("sensor packet_length: %d", packet->length);
-
-                       free(r_databuf);
-                       r_databuf = NULL;
-                       recvd_size = recv_data(event_fd, &r_databuf, packet->length);
-
-                       LOG("Something may be added in the data end, but it does not matter.");
-                       LOG("sensor data recv buffer: %s", r_databuf);
-
-                       if (packet->group == STATUS) {
-                               g_get_status_sockfd = event_fd;
-                               ActionID = packet->action;
-                               memset(GetBuffer, '\0', sizeof(GetBuffer));
-                               strcpy(GetBuffer, r_databuf);
-                               LOG("GetBuffer is %s", GetBuffer);
-
-                               if(pthread_create(&tid[2], NULL, setting_device, NULL) != 0) {
-                                       LOG("pthread create fail!");
-                               }
-                       }
-                       else if(sendto(uSensordFd, r_databuf, packet->length, 0, (struct sockaddr*)&si_sensord_other, sslen) == -1) {     
-                               LOG("sendto error!");
-                       }
-               }
-               else if(strncmp(tmpbuf, "location", 8) == 0)
-               {
-                       recvd_size = recv_data(event_fd, &r_databuf, HEADER_SIZE);
-                       memcpy((void*)packet, (void*)r_databuf, HEADER_SIZE);
-
-                       LOG("location packet_length: %d", packet->length);
-
-                       free(r_databuf);
-                       r_databuf = NULL;
-                       recvd_size = recv_data(event_fd, &r_databuf, packet->length);
-
-                       LOG("Something may be added in the data end, but it does not matter.");
-                       LOG("location data recv buffer: %s", r_databuf);
-
-                       if (packet->group == STATUS) {
-                               g_get_status_sockfd = event_fd;
-                               ActionID = packet->action;
-                               memset(GetBuffer, '\0', sizeof(GetBuffer));
-                               strcpy(GetBuffer, r_databuf);
-                               LOG("GetBuffer is %s", GetBuffer);
-
-                               if(pthread_create(&tid[2], NULL, setting_device, NULL) != 0) {
-                                       LOG("pthread create fail!");
-                               }
-                       } else {
-                               setting_location(r_databuf);
-                       }
-               }
-               else if(strncmp(tmpbuf, "nfc", 3) == 0)
-               {
-                       recvd_size = recv_data(event_fd, &r_databuf, HEADER_SIZE);
-                       if( recvd_size <= 0 )
-                       {
-                               free(r_databuf);
-                               r_databuf = NULL;
-                               free(packet);
-                               packet = NULL;
-                               return;
-                       }
-
-                       memcpy((void*)packet, (void*)r_databuf, HEADER_SIZE);
-                       LOG("nfc packet_length: %d", packet->length);
-
-                       free(r_databuf);
-                       r_databuf = NULL;
-                       recvd_size = recv_data(event_fd, &r_databuf, packet->length);
-                       if(r_databuf == NULL){
-                           free(packet);
-                           packet = NULL;
-                           return;
-                       }
-                       LOG("nfc data recv buffer: %s", r_databuf);
-
-                       if (packet->group == STATUS) {
-                               g_get_status_sockfd = event_fd;
-                               ActionID = packet->action;
-                               memset(GetBuffer, '\0', sizeof(GetBuffer));
-                               strcpy(GetBuffer, r_databuf);
-                               LOG("GetBuffer is %s", GetBuffer);
-
-                               if(pthread_create(&tid[2], NULL, setting_device, NULL) != 0) {
-                                       LOG("pthread create fail!");
-                               }
-                       } else {
-                               FILE* fd;
-                               fd = fopen("/opt/nfc/sdkMsg", "w");
-                               if(!fd)
-                               {
-                                       LOG("nfc file open fail!");
-                                       free(r_databuf);
-                                       r_databuf = NULL;
-                                       free(packet);
-                                       packet = NULL;
-                                       return;
-                               }
-                               fprintf(fd, "%s", r_databuf);
-                               fclose(fd);
-                               //free(strbuf);
-                               //strbuf = NULL;
-                       }
-               }
-               else if(strncmp(tmpbuf, "system", 6) == 0)
-               {
-
-                       recvd_size = recv_data(event_fd, &r_databuf, HEADER_SIZE);
-                       memcpy((void*)packet, (void*)r_databuf, HEADER_SIZE);
-
-                       LOG("system packet_length: %d", packet->length);
-
-                       free(r_databuf);
-                       r_databuf = NULL;
-                       recvd_size = recv_data(event_fd, &r_databuf, packet->length);
-
-                       LOG("Something may be added in the data end, but it does not matter.");
-                       LOG("system data recv buffer: %s", r_databuf);
-                       LOG("/etc/rc.d/rc.shutdown, sync, reboot(RB_POWER_OFF)");
-
-                       LOG("sync");
-                       sync();
-                       system("/etc/rc.d/rc.shutdown &");
-                       gettimeofday(&tv_start_poweroff, NULL);
-                       powerdown_by_force();
-
-               }
-               else if(strncmp(tmpbuf, "sdcard", 6) == 0)
-               {
-                       g_sdcard_sockfd = event_fd;
-                       recvd_size = recv_data(event_fd, &r_databuf, HEADER_SIZE);
-                       memcpy((void*)packet, (void*)r_databuf, HEADER_SIZE);   
-
-                       LOG("sdcard packet_length: %d", packet->length);
-
-                       free(r_databuf);
-                       r_databuf = NULL;
-                       recvd_size = recv_data(event_fd, &r_databuf, packet->length);
-                       if(recvd_size <= 0){
-                               LOG("client_recv: recv_data err");
-                               if(r_databuf) {
-                                       free(r_databuf);
-                                       r_databuf = NULL;
-                               }
-                               if(packet) {
-                                       free(packet);
-                                       packet = NULL;
-                               }
-                               LOG("close event_fd: %d", event_fd);
-                               userpool_delete(event_fd);
-                               close(event_fd); /* epoll set fd also deleted automatically by this call as a spec */
-                               if(event_fd == g_sdbd_sockfd)
-                                       g_sdbd_sockfd = -1;
-                               return;
-                       }
-
-                       LOG("Something may be added in the data end, but it does not matter.");
-                       LOG("sdcard data recv buffer: %s", r_databuf);
-                       
-                       char token[] = "\n";
-                       char tmpdata[recvd_size];
-                       memcpy(tmpdata, r_databuf, recvd_size);
-
-                       char* ret = NULL;
-                       ret = strtok(tmpdata, token);
-                       LOG("%s", ret);
-                       int mount_param = atoi(ret);
-                       int mount_status = 0;
-
-                       switch(mount_param)
-                       {
-                       case 0:                                                 // umount
-                               mount_status = umount_sdcard();
-                               if(mount_status == 0)                           
-                                       send_guest_server(r_databuf);
-                               break;
-                       case 1:                                                 // mount
-                               memset(SDpath, '\0', sizeof(SDpath));
-                               ret = strtok(NULL, token);
-                               strcpy(SDpath, ret);
-                               LOG("sdcard path is %s", SDpath);
-
-                               send_guest_server(r_databuf);
-                               if(pthread_create(&tid[1], NULL, mount_sdcard, NULL) != 0)
-                                       LOG("pthread create fail!");
-                               break;
-                       case 2:                                                 // mount status
-                               mount_status = is_mounted();
-
-                               LXT_MESSAGE* mntData = (LXT_MESSAGE*)malloc(sizeof(LXT_MESSAGE));
-                               if(mntData == NULL){
-                                   break;
-                               }
-                               memset(mntData, 0, sizeof(LXT_MESSAGE));
-
-                               mntData->length = strlen(SDpath);       // length
-                               mntData->group = 11;                    // sdcard
-
-                               switch(mount_status)
-                               {
-                               case 0:
-                                       mntData->action = 2;                    // umounted status
-                                       send(g_sdcard_sockfd, (void*)mntData, sizeof(char) * HEADER_SIZE, 0);
-                                       
-                                       LOG("SDpath is %s", SDpath);
-                                       send(g_sdcard_sockfd, SDpath, mntData->length, 0);
-                                       memset(SDpath, '\0', sizeof(SDpath));
-                                       sprintf(SDpath, "umounted");
-                                       break;
-                               case 1:
-                                       mntData->action = 3;                    // mounted status
-                                       send(g_sdcard_sockfd, (void*)mntData, sizeof(char) * HEADER_SIZE, 0);
-
-                                       LOG("SDpath is %s", SDpath);
-                                       send(g_sdcard_sockfd, SDpath, mntData->length, 0);
-                                       break;
-                               default:
-                                       break;
-                               }
-                               free(mntData);
-                               break;
-                       default:
-                               LOG("unknown data %s", ret);
-                               break;
-                       }       
-               }               
-               else
-               {
-                       LOG("Unknown packet: %s", tmpbuf);
-                       userpool_delete(event_fd);
-                       close(event_fd); /* epoll set fd also deleted automatically by this call as a spec */
-               }
-       }
-       if(r_databuf)
-       {
-               free(r_databuf);
-               r_databuf = NULL;
-       }
-       if(packet)
-       {
-               free(packet);
-               packet = NULL;
-       }
-}
-
-void server_process(void)
-{
-       struct sockaddr_in cli_addr;
-       int i,nfds;
-       int cli_sockfd;
-       int cli_len = sizeof(cli_addr);
-
-       nfds = epoll_wait(g_epoll_fd,g_events,MAX_EVENTS,100); /* timeout 100ms */
-
-       if(nfds == 0){
-               /* no event , no work */
-               return;
-       }
-
-
-       if(nfds < 0) {
-               fprintf(stderr, "epoll wait error\n");
-               /* return but this is epoll wait error */
-               return;
-       } 
-
-       for( i = 0 ; i < nfds ; i++ )
-       {
-               /* connect client */
-               if(g_events[i].data.fd == g_svr_sockfd)
-               {
-                       cli_sockfd = accept(g_svr_sockfd, (struct sockaddr *)&cli_addr,(socklen_t *)&cli_len);
-                       if(cli_sockfd < 0) 
-                       {
-                               /* accept error */
-                               fprintf(stderr, "accept error\n");
-                       }
-                       else
-                       {
-                               LOG("[Accpet] New client connected. fd:%d, port:%d"
-                                               ,cli_sockfd, cli_addr.sin_port);
-
-                               /* save client port */
-                               userpool_add(cli_sockfd, cli_addr.sin_port);
-
-                               /* for vmodem to sdbd directly */
-                               //g_sdbd_sockfd = cli_sockfd;
-
-                               /* add client sockfd at event pool */
-                               epoll_cli_add(cli_sockfd);
-                       }
-                       continue; /* next fd */
-               }
-               /* if not server socket , this socket is for client socket, so we read it */
-
-               client_recv(g_events[i].data.fd);    
-       } /* end of for 0-nfds */
-}
-/*------------------------------- end of function server_process */
-
-void end_server(int sig)
-{
-       close(g_svr_sockfd); /* close server socket */
-       close(uSensordFd);
-       close(uGpsdFd);
-       LOG("[SHUTDOWN] Server closed by signal %d",sig);
-
-       exit(0);
-}
-
-void setting_device()
-{
-       pthread_detach(pthread_self());
-
-       char* msg = 0;
-       LXT_MESSAGE* packet = (LXT_MESSAGE*)malloc(sizeof(LXT_MESSAGE));
-
-       switch(ActionID)
-       {
-       case BATTERY_LEVEL:
-               msg = get_battery_level((void*)packet);
-               if (msg == 0) {
-                       LOG("failed getting battery level");
-               }
-       break;
-       case BATTERY_CHARGER:
-               msg = get_battery_charger((void*)packet);
-               if (msg == 0) {
-                       LOG("failed getting battery charger state");
-               }
-       break;
-       case USB_STATUS:
-               msg = get_usb_status((void*)packet);
-               if (msg == 0) {
-                       LOG("failed getting usb status");
-               }
-       break;
-       case EARJACK_STATUS:
-               msg = get_earjack_status((void*)packet);
-               if (msg == 0) {
-                       LOG("failed getting earjack status");
-               }
-       break;
-       case RSSI_LEVEL:
-               msg = get_rssi_level((void*)packet);
-               if (msg == 0) {
-                       LOG("failed getting rssi level");
-               }
-       break;
-       case ACCEL_VALUE:
-               msg = get_acceleration_value((void*)packet);
-               if (msg == 0) {
-                       LOG("falied getting acceleration value");
-               }
-       break;
-       case GYRO_VALUE:
-               msg = get_gyroscope_value((void*)packet);
-               if (msg == 0) {
-                       LOG("failed getting gyroscope value");
-               }
-       break;
-       case MAG_VALUE:
-               msg = get_magnetic_value((void*)packet);
-               if (msg == 0) {
-                       LOG("failed getting magnetic value");
-               }
-       break;
-       case LIGHT_VALUE:
-               msg = get_light_level((void*)packet);
-               if (msg == 0) {
-                       LOG("failed getting light level");
-               }
-       break;
-       case PROXI_VALUE:
-               msg = get_proximity_status((void*)packet);
-               if (msg == 0) {
-                       LOG("failed getting proximity status");
-               }
-       break;
-       case MOTION_VALUE:
-               LOG("not support getting motion value");
-       break;
-       case LOCATION_STATUS:
-               msg = get_location_status((void*)packet);
-               if (msg == 0) {
-                       LOG("failed getting location status");
-               }
-       break;
-       case NFC_STATUS:
-               msg = get_nfc_status((void*)packet);
-               if (msg ==0) {
-                       LOG("failed getting nfc status");
-               }
-       break;
-       default:
-               //TODO
-       break;
-       }
-
-       if (g_get_status_sockfd != -1) {
-               if (msg != 0) {
-                       LOG("send data to injector");
-               } else {
-                       LOG("send error message to injector");
-                       memset(packet, 0, sizeof(LXT_MESSAGE));
-                       packet->length = 0;
-                       packet->group  = STATUS;
-                       packet->action = ActionID;
-               }
-               send(g_get_status_sockfd, (void*)packet, sizeof(char) * HEADER_SIZE, 0);
-               if (packet->length != 0) {
-                       send(g_get_status_sockfd, msg, packet->length, 0);
-               }
-       }
-
-       if(msg != 0) {
-               free(msg);
-       }
-       free(packet);
-
-       pthread_exit((void *) 0); 
-}
-
-// location event
-char command[512];
-char latitude[128];
-char longitude[128];
-void setting_location(char* databuf)
-{
-       char* s = strchr(databuf, ',');
-       memset(command, 0, 256);
-       if (s == NULL) { // SET MODE
-               int mode = atoi(databuf);
-               switch (mode) {
-               case 0: // STOP MODE
-                       sprintf(command, "vconftool set -t int db/location/replay/ReplayMode 0 -f");
-                       break;
-               case 1: // NMEA MODE (LOG MODE)
-                       sprintf(command, "vconftool set -t int db/location/replay/ReplayMode 1 -f");
-                       break;
-               case 2: // MANUAL MODE
-                       sprintf(command, "vconftool set -t int db/location/replay/ReplayMode 2 -f");
-                       break;
-               default:
-                       LOG("error(%s) : stop replay mode", databuf);
-                       sprintf(command, "vconftool set -t int db/location/replay/ReplayMode 0 -f");
-                       break;
-               }
-               LOG("Location Command : %s", command);
-               system(command);
-       } else {
-               *s = '\0';
-               int mode = atoi(databuf);
-               if(mode == 1) { // NMEA MODE (LOG MODE)
-                       sprintf(command, "vconftool set -t string db/location/replay/FileName \"%s\"", s+1);
-                       LOG("%s", command);
-                       system(command);
-                       memset(command, 0, 256);
-                       sprintf(command, "vconftool set -t int db/location/replay/ReplayMode 1 -f");
-                       LOG("%s", command);
-                       system(command);
-               } else if(mode == 2) {
-                       memset(latitude,  0, 128);
-                       memset(longitude, 0, 128);
-                       char* t = strchr(s+1, ',');
-                       *t = '\0';
-                       strcpy(latitude, s+1);
-                       strcpy(longitude, t+1);
-                       //strcpy(longitude, s+1);
-                       //strcpy(latitude, databuf);
-                       // Latitude
-                       sprintf(command, "vconftool set -t double db/location/replay/ManualLatitude %s -f", latitude);
-                       LOG("%s", command);
-                       system(command);
-
-                       // Longitude
-                       sprintf(command, "vconftool set -t double db/location/replay/ManualLongitude %s -f", longitude);
-                       LOG("%s", command);
-                       system(command);
-               }
-       }
-}
-
-//sdcard event
-void send_guest_server(char* databuf)
-{
-       char buf[32];
-       struct sockaddr_in si_other;
-       int s, slen=sizeof(si_other);
-       FILE* fd;
-       char fbuf[16];
-       int port;
-       fd = fopen("/opt/home/sdb_port.txt", "r");
-       LOG("sdb_port.txt fopen fd is %d", fd);
-       if(!fd)
-       {
-               LOG("fopen /opt/home/sdb_port.txt fail");
-               port = 3581;
-       }
-       else
-       {
-               fgets(fbuf, 16, fd);
-               fclose(fd);
-               port = atoi(fbuf) + 3;
-       }
-
-       if ((s=socket(AF_INET, SOCK_DGRAM, IPPROTO_UDP))==-1)
-       {
-               LOG("socket error!");
-               return;
-       }
-           
-       memset((char *) &si_other, 0, sizeof(si_other));
-       si_other.sin_family = AF_INET;
-       si_other.sin_port = htons(port);
-       if (inet_aton(SRV_IP, &si_other.sin_addr)==0) {
-                 fprintf(stderr, "inet_aton() failed\n");
-       }
-
-       memset(buf, '\0', sizeof(buf));
-       sprintf(buf, "4\n%s", databuf);
-       LOG("sendGuestServer msg: %s", buf);
-       if(sendto(s, buf, sizeof(buf), 0, (struct sockaddr*)&si_other, slen) == -1)
-       {     
-               LOG("sendto error!");
-       }
-       
-       close(s);
-}
-
-int main( int argc , char *argv[])
-{
-       if(log_print == 1)
-       {
-               // for emuld log file
-               system("rm /opt/sensor/emuld.log");
-               system("touch /opt/sensor/emuld.log");
-       }
-
-       LOG("start");
-       /* entry , argument check and process */
-       if(argc < 3){ 
-
-               g_svr_port = DEFAULT_PORT;
-
-       }else {
-
-               if(strcmp("-port",argv[1]) ==  0 ) {
-
-                       g_svr_port = atoi(argv[2]);
-                       if(g_svr_port < 1024) {
-                               fprintf(stderr, "[STOP] port number invalid : %d\n",g_svr_port);
-                               exit(0);
-                       } 
-               }
-       }
-
-       init_data0();   
-
-       /* init server */
-       init_server0(g_svr_port);
-
-       epoll_init();    /* epoll initialize  */
-       if(pthread_create(&tid[0], NULL, init_vm_connect, NULL) != 0)
-               LOG("pthread create fail!");
-
-       udp_init();
-
-       /* main loop */
-       while(1)
-       {
-               server_process();  /* accept process. */
-       } /* infinite loop while end. */
-}
-
diff --git a/src/emuld.cpp b/src/emuld.cpp
new file mode 100644 (file)
index 0000000..71a4133
--- /dev/null
@@ -0,0 +1,911 @@
+/* -*- Mode: C; c-basic-offset: 8; indent-tabs-mode: t -*-
+ * emulator-daemon
+ *
+ * Copyright (c) 2000 - 2011 Samsung Electronics Co., Ltd. All rights reserved.
+ *
+ * Contact:
+ * DaiYoung Kim <daiyoung777.kim@samsnung.com>
+ * SooYoung Ha <yoosah.ha@samsnung.com>
+ * Sungmin Ha <sungmin82.ha@samsung.com>
+ * YeongKyoon Lee <yeongkyoon.lee@samsung.com>
+ * 
+ * Licensed under the Apache License, Version 2.0 (the "License");
+ * you may not use this file except in compliance with the License.
+ * You may obtain a copy of the License at
+ *
+ * http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS,
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ * 
+ * Contributors:
+ * - S-Core Co., Ltd
+ *
+ */
+
+/*-----------------------------------------------------------------
+
+epoll server program by Sungmin Ha.
+Platform : Linux 2.6.x (kernel)
+compiler Gcc: 3.4.3. 
+License: GNU General Public License   
+
+------------------------------------------------------------------*/
+#include "emuld_common.h"
+#include "emuld.h"
+#include "synbuf.h"
+
+
+#define MAX_CONNECT_TRY_COUNT  (60 * 3)
+#define SRV_IP "10.0.2.2"
+
+/* global definition */
+unsigned short vmodem_port = VMODEM_PORT;
+unsigned short sensord_port = SENSORD_PORT;
+
+int g_svr_port;                        /* global server port number */
+
+static int g_vm_connect_status;        /* connection status between emuld and vmodem  */
+
+
+pthread_t tid[MAX_CLIENT + 1];
+
+
+/* udp socket */
+struct sockaddr_in si_sensord_other;
+
+
+
+int g_fd[fdtype_max];
+
+
+typedef std::queue<msg_info*> __msg_queue;
+
+__msg_queue g_msgqueue;
+
+
+int g_epoll_fd;
+
+static pthread_mutex_t mutex_vmconnect = PTHREAD_MUTEX_INITIALIZER;
+
+struct epoll_event g_events[MAX_EVENTS]; 
+
+bool exit_flag = false;
+/*--------------------------------------------------------------*/
+/* FUNCTION PART 
+   ---------------------------------------------------------------*/
+
+
+
+void systemcall(const char* param)
+{
+       if (!param)
+               return;
+
+       if (system(param) == -1)
+               LOG("system call failure(command = %s)\n", param);
+}
+
+
+/*---------------------------------------------------------------
+function : init_data0
+io: none
+desc: initialize global client structure values
+----------------------------------------------------------------*/
+void init_data0(void)
+{
+       register int i;
+
+       for(i = 0 ; i < fdtype_max ; i++)
+       {
+               g_fd[i] = -1;
+       }
+}
+
+bool is_vm_connected(void)
+{
+       _auto_mutex _(&mutex_vmconnect);
+
+       if (g_vm_connect_status != 1)
+               return false;
+
+       return true;
+}
+
+void set_vm_connect_status(const int v)
+{
+       _auto_mutex _(&mutex_vmconnect);
+
+       g_vm_connect_status = v;
+}
+
+
+
+
+/*------------------------------------------------------------- 
+function: init_server0 
+io: input : integer - server port (must be positive)
+output: none
+desc : tcp/ip listening socket setting with input variable
+----------------------------------------------------------------*/
+
+bool init_server0(int svr_port, int* ret_fd)
+{
+       struct sockaddr_in serv_addr;
+       int fd;
+
+       *ret_fd = -1;
+
+       /* Open TCP Socket */
+       if ((fd = socket(AF_INET, SOCK_STREAM, 0)) < 0)
+       {
+               fprintf(stderr, "Server Start Fails. : Can't open stream socket \n");
+               return false;
+       }
+
+       /* Address Setting */
+       memset(&serv_addr , 0 , sizeof(serv_addr)) ;
+
+       serv_addr.sin_family = AF_INET;
+       serv_addr.sin_addr.s_addr = htonl(INADDR_ANY);
+       serv_addr.sin_port = htons(svr_port);
+
+       /* Set Socket Option  */
+       int nSocketOpt = 1;
+       if (setsockopt(fd, SOL_SOCKET, SO_REUSEADDR, &nSocketOpt, sizeof(nSocketOpt)) < 0)
+       {
+               fprintf(stderr, "Server Start Fails. : Can't set reuse address\n");
+               goto fail;
+       }
+
+       /* Bind Socket */
+       if (bind(fd,(struct sockaddr *)&serv_addr, sizeof(serv_addr)) < 0)
+       {
+               fprintf(stderr, "Server Start Fails. : Can't bind local address\n");
+               goto fail;
+       }
+
+       /* Listening */
+       if (listen(fd, 15) < 0) /* connection queue is 15. */
+       {
+               fprintf(stderr, "Server Start Fails. : listen failure\n");
+               goto fail;
+       }
+       LOG("[START] Now Server listening on port %d, EMdsockfd: %d"
+                       ,svr_port, fd);
+    
+    /* notify to qemu that emuld is ready */
+    emuld_ready();
+
+       if (!epoll_ctl_add(fd))
+       {
+               fprintf(stderr, "Epoll control fails.\n");
+               goto fail;
+       }
+
+       *ret_fd = fd;
+
+       return true;
+fail:
+       close(fd);
+       return false;
+} 
+/*------------------------------- end of function init_server0 */
+
+void emuld_ready()
+{
+    char buf[16];
+
+    struct sockaddr_in si_other;
+    int s, slen=sizeof(si_other);
+    int port;
+    char *ptr;
+    char *temp_sdbport;
+    temp_sdbport = getenv("sdb_port");
+    if(temp_sdbport == NULL) {
+        fprintf(stderr, "failed to get env variable from sdb_port\n");
+        return;
+    }
+
+    port = strtol(temp_sdbport, &ptr, 10);
+    port = port + 3;
+
+    fprintf(stderr, "guest_server port: %d\n", port);
+
+    if ((s=socket(AF_INET, SOCK_DGRAM, IPPROTO_UDP))==-1){
+        fprintf(stderr, "socket error!\n");
+        return;
+    }
+
+    memset((char *) &si_other, 0, sizeof(si_other));
+    si_other.sin_family = AF_INET;
+    si_other.sin_port = htons(port);
+    if (inet_aton(SRV_IP, &si_other.sin_addr)==0) {
+        fprintf(stderr, "inet_aton() failed\n");
+    }
+
+    memset(buf, '\0', sizeof(buf));
+
+    sprintf(buf, "5\n");
+
+    fprintf(stderr, "send message to guest server\n");
+
+    while(sendto(s, buf, sizeof(buf), 0, (struct sockaddr*)&si_other, slen) == -1)
+    {     
+        fprintf(stderr, "sendto error! retry sendto\n");
+        usleep(1000);
+    }
+    fprintf(stderr, "emuld is ready.\n");      
+    close(s);
+
+}
+
+void* init_vm_connect(void* data)
+{
+       struct sockaddr_in vm_addr;
+       int ret = -1;   
+       bool is_connected = false;
+
+       set_vm_connect_status(0);
+
+       LOG("init_vm_connect start\n");
+
+       pthread_detach(pthread_self());
+       /* Open TCP Socket */
+       if ((g_fd[fdtype_vmodem] = socket(AF_INET, SOCK_STREAM, 0)) < 0)
+       {
+               fprintf(stderr, "Server Start Fails. : Can't open stream socket \n");
+               exit(0);
+       }
+
+       /* Address Setting */
+       memset( &vm_addr , 0 , sizeof(vm_addr)) ; 
+
+       vm_addr.sin_family = AF_INET;
+       vm_addr.sin_addr.s_addr = inet_addr("127.0.0.1");
+       vm_addr.sin_port = htons(vmodem_port);
+
+       while (ret < 0 && !exit_flag)
+       {
+               ret = connect(g_fd[fdtype_vmodem], (struct sockaddr *)&vm_addr, sizeof(vm_addr));
+
+               LOG("vm_sockfd: %d, connect ret: %d\n", g_fd[fdtype_vmodem], ret);
+
+               if(ret < 0) {
+                       LOG("connection failed to vmodem! try \n");
+                       sleep(1);
+               }
+               else
+               {
+                       is_connected = true;
+               }
+       }
+       
+       epoll_ctl_add(g_fd[fdtype_vmodem]);
+       
+       set_vm_connect_status(1);
+
+       pthread_exit((void *) 0); 
+}
+
+
+
+bool epoll_ctl_add(const int fd)
+{
+       struct epoll_event events;
+
+       events.events = EPOLLIN;        // check In event
+       events.data.fd = fd;
+
+       if (epoll_ctl(g_epoll_fd, EPOLL_CTL_ADD, fd, &events) < 0 )
+       {
+               fprintf(stderr, "Epoll control fails.\n");
+               return false;
+       }
+
+       printf("[START] epoll events set success for server\n");
+       return true;
+}
+
+bool epoll_init(void)
+{
+       g_epoll_fd = epoll_create(MAX_EVENTS); // create event pool
+       if(g_epoll_fd < 0)
+       {
+               fprintf(stderr, "Epoll create Fails.\n");
+               return false;
+       }
+
+       LOG("[START] epoll creation success\n");
+       return true;
+}
+
+
+
+/*------------------------------- end of function epoll_init */
+
+
+int parse_val(char *buff, unsigned char data, char *parsbuf)
+{
+       int count=0;
+       while(1)
+       {
+               if(count > 40)
+                       return -1;
+               if(buff[count] == data)
+               {
+                       count++;
+                       strncpy(parsbuf, buff, count);
+                       return count;
+               }
+               count++;
+       }
+
+       return 0;
+}
+
+#define STR_HELPER(x) #x
+#define STR(x) STR_HELPER(x)
+
+void udp_init(void)
+{
+       char emul_ip[HOST_NAME_MAX+1];
+       struct addrinfo *res;
+       struct addrinfo hints;
+       int rc;
+
+       LOG("start");
+
+       memset(emul_ip, 0, sizeof(emul_ip));
+       if (gethostname(emul_ip, sizeof(emul_ip)) < 0)
+       {
+               LOG("gethostname(): %s", strerror(errno));
+               assert(0);
+       }
+
+       memset(&hints, 0, sizeof(hints));
+       hints.ai_family = AF_INET;
+       hints.ai_socktype = SOCK_DGRAM;
+       hints.ai_protocol = IPPROTO_UDP;
+
+       if ((rc=getaddrinfo(emul_ip, STR(SENSORD_PORT), &hints, &res)) != 0)
+       {
+               if (rc == EAI_SYSTEM)
+                       LOG("getaddrinfo(sensord): %s", strerror(errno));
+               else
+                       LOG("getaddrinfo(sensord): %s", gai_strerror(rc));
+               assert(0);
+       }
+
+       if ((g_fd[fdtype_sensor] = socket(res->ai_family, res->ai_socktype, res->ai_protocol)) == -1)
+       {
+               fprintf(stderr, "socket error!\n");
+       }
+
+       if (res->ai_addrlen > sizeof(si_sensord_other))
+       {
+               LOG("sockaddr structure too big");
+               /* XXX: if you `return' remember to clean up */
+               assert(0);
+       }
+       memset((char *) &si_sensord_other, 0, sizeof(si_sensord_other));
+       memcpy((char *) &si_sensord_other, res->ai_addr, res->ai_addrlen);
+       freeaddrinfo(res);
+}
+
+#undef STR_HELPER
+#undef STR
+
+int recv_data(int event_fd, char** r_databuf, int size)
+{
+       int recvd_size = 0;
+       int len = 0;
+       int getcnt = 0;
+       char* r_tmpbuf = NULL;
+       const int alloc_size = sizeof(char) * size + 1;
+
+       r_tmpbuf = (char*)malloc(alloc_size);
+       if(r_tmpbuf == NULL)
+       {
+           return -1;
+       }
+
+       char* databuf = (char*)malloc(alloc_size);
+       if(databuf == NULL)
+       {
+           free(r_tmpbuf);
+           *r_databuf = NULL;
+           return -1;
+       }
+
+       memset(databuf, '\0', alloc_size);
+
+       while(recvd_size < size)
+       {
+               memset(r_tmpbuf, '\0', alloc_size);
+               len = recv(event_fd, r_tmpbuf, size - recvd_size, 0);
+               if (len < 0) {
+                       break;
+               }
+
+               memcpy(databuf + recvd_size, r_tmpbuf, len);
+               recvd_size += len;
+               getcnt++;
+               if(getcnt > MAX_GETCNT) {
+                       break;
+               }
+       }
+       free(r_tmpbuf);
+       r_tmpbuf = NULL;
+
+       *r_databuf = databuf;
+
+       return recvd_size;
+}
+
+int read_header(int fd, LXT_MESSAGE* packet)
+{
+       char* readbuf = NULL;
+       int readed = recv_data(fd, &readbuf, HEADER_SIZE);
+       if (readed <= 0)
+               return 0;
+       memcpy((void*) packet, (void*) readbuf, HEADER_SIZE);
+
+       if (readbuf)
+       {
+               free(readbuf);
+               readbuf = NULL;
+       }
+       return readed;
+}
+
+
+bool read_ijcmd(const int fd, ijcommand* ijcmd)
+{
+       int readed;
+       readed = read_header(fd, &ijcmd->msg);
+
+       LOG("action: %d", ijcmd->msg.action);
+       LOG("length: %d", ijcmd->msg.length);
+
+       if (readed <= 0)
+               return false;
+
+       // TODO : this code should removed, for telephony
+       if (ijcmd->msg.length == 0)
+       {
+               if (ijcmd->msg.action == 71)    // that's strange packet from telephony initialize
+               {
+                       ijcmd->msg.length = 4;
+               }
+       }
+
+       if (ijcmd->msg.length <= 0)
+               return true;
+
+       if (ijcmd->msg.length > 0)
+       {
+               readed = recv_data(fd, &ijcmd->data, ijcmd->msg.length);
+               if (readed <= 0)
+               {
+                       free(ijcmd->data);
+                       ijcmd->data = NULL;
+                       return false;
+               }
+
+       }
+       return true;
+}
+
+bool read_id(const int fd, ijcommand* ijcmd)
+{
+       char* readbuf = NULL;
+       int readed = recv_data(fd, &readbuf, ID_SIZE);
+
+       LOG("read_id : receive size: %d", readed);
+
+       if (readed <= 0)
+       {
+               free(readbuf);
+               readbuf = NULL;
+               return false;
+       }
+
+       LOG("identifier: %s", readbuf);
+
+       memset(ijcmd->cmd, '\0', sizeof(ijcmd->cmd));
+       int parselen = parse_val(readbuf, 0x0a, ijcmd->cmd);
+
+       LOG("parse_len: %d, buf = %s, fd=%d", parselen, ijcmd->cmd, fd);
+
+       if (readbuf)
+       {
+               free(readbuf);
+               readbuf = NULL;
+       }
+
+       return true;
+}
+
+
+void recv_from_vmodem(int fd)
+{
+       printf("recv_from_vmodem\n");
+
+       ijcommand ijcmd;
+       if (!read_ijcmd(fd, &ijcmd))
+       {
+               LOG("fail to read ijcmd\n");
+
+               set_vm_connect_status(0);
+
+               close(fd);
+
+               if (pthread_create(&tid[0], NULL, init_vm_connect, NULL) != 0)
+               {
+                       LOG("pthread create fail!");
+               }
+               return;
+       }
+
+       LOG("vmodem data length: %d", ijcmd.msg.length);
+    const int tmplen = HEADER_SIZE + ijcmd.msg.length; 
+    char* tmp = (char*) malloc(tmplen);
+
+    if (tmp)
+    {
+        memcpy(tmp, &ijcmd.msg, HEADER_SIZE);
+        if (ijcmd.msg.length > 0)
+            memcpy(tmp + HEADER_SIZE, ijcmd.data, ijcmd.msg.length);
+
+        if(!ijmsg_send_to_evdi(g_fd[fdtype_device], IJTYPE_TELEPHONY, (const char*) tmp, tmplen)) {
+            LOG("msg_send_to_evdi: failed\n");
+        }
+
+        free(tmp);
+    }
+
+       // send header to ij
+       if (is_ij_exist())
+       {
+               send_to_all_ij((char*) &ijcmd.msg, HEADER_SIZE);
+
+               if (ijcmd.msg.length > 0)
+               {
+                       send_to_all_ij((char*) ijcmd.data, ijcmd.msg.length);
+               }
+       }
+}
+
+
+void recv_from_ij(int fd)
+{
+       printf("recv_from_ij\n");
+
+       ijcommand ijcmd;
+
+       if (!read_id(fd, &ijcmd))
+       {
+               close_cli(fd);
+               return;
+       }
+
+       // TODO : if recv 0 then close client
+
+       if (!read_ijcmd(fd, &ijcmd))
+       {
+               LOG("fail to read ijcmd\n");
+               return;
+       }
+
+
+       if (strncmp(ijcmd.cmd, "telephony", 9) == 0)
+       {
+               msgproc_telephony(fd, &ijcmd, false);
+       }
+       else if (strncmp(ijcmd.cmd, "sensor", 6) == 0)
+       {
+               msgproc_sensor(fd, &ijcmd, false);
+       }
+       else if (strncmp(ijcmd.cmd, "location", 8) == 0)
+       {
+               msgproc_location(fd, &ijcmd, false);
+       }
+       else if (strncmp(ijcmd.cmd, "nfc", 3) == 0)
+       {
+               msgproc_nfc(fd, &ijcmd, false);
+       }
+       else if (strncmp(ijcmd.cmd, "system", 6) == 0)
+       {
+               msgproc_system(fd, &ijcmd, false);
+       }
+       else if (strncmp(ijcmd.cmd, "sdcard", 6) == 0)
+       {
+               msgproc_sdcard(fd, &ijcmd, false);
+       }
+       else
+       {
+               LOG("Unknown packet: %s", ijcmd.cmd);
+               close_cli (fd);
+       }
+}
+
+bool accept_proc(const int server_fd)
+{
+       struct sockaddr_in cli_addr;
+       int cli_sockfd;
+       int cli_len = sizeof(cli_addr);
+
+       cli_sockfd = accept(server_fd, (struct sockaddr *)&cli_addr,(socklen_t *)&cli_len);
+       if(cli_sockfd < 0)
+       {
+               fprintf(stderr, "accept error\n");
+               return false;
+       }
+       else
+       {
+               LOG("[Accpet] New client connected. fd:%d, port:%d"
+                               ,cli_sockfd, cli_addr.sin_port);
+
+               clipool_add(cli_sockfd, cli_addr.sin_port, fdtype_ij);
+               epoll_ctl_add(cli_sockfd);
+       }
+       return true;
+}
+
+
+static synbuf g_synbuf;
+
+void process_evdi_command(ijcommand* ijcmd)
+{
+       int fd = -1;
+
+       if (strncmp(ijcmd->cmd, "telephony", 9) == 0)
+       {
+               msgproc_telephony(fd, ijcmd, true);
+       }
+       else if (strncmp(ijcmd->cmd, "sensor", 6) == 0)
+       {
+               msgproc_sensor(fd, ijcmd, true);
+       }
+       else if (strncmp(ijcmd->cmd, "location", 8) == 0)
+       {
+               msgproc_location(fd, ijcmd, true);
+       }
+       else if (strncmp(ijcmd->cmd, "nfc", 3) == 0)
+       {
+               msgproc_nfc(fd, ijcmd, true);
+       }
+       else if (strncmp(ijcmd->cmd, "system", 6) == 0)
+       {
+               msgproc_system(fd, ijcmd, true);
+       }
+       else if (strncmp(ijcmd->cmd, "sdcard", 6) == 0)
+       {
+               msgproc_sdcard(fd, ijcmd, true);
+       }
+       else
+       {
+               LOG("Unknown packet: %s", ijcmd->cmd);
+       }
+}
+
+//static long recv_count = 0;
+
+void recv_from_evdi(evdi_fd fd)
+{
+       printf("recv_from_evdi\n");
+       int readed;
+
+       struct msg_info _msg;
+       int to_read = sizeof(struct msg_info);
+
+       memset(&_msg, 0x00, sizeof(struct msg_info));
+
+
+       while (1)
+       {
+               readed = read(fd, &_msg, to_read);
+               if (readed == -1) // TODO : error handle
+               {
+                       if (errno != EAGAIN)
+                       {
+                               perror ("recv_from_evdi : EAGAIN\n");
+                               LOG("EAGAIN\n");
+                               return;
+                       }
+               }
+               else
+               {
+                       break;
+               }
+       }
+
+       //LOG("RECV COUNT = %d\n", ++recv_count);
+       LOG("total readed  = %d, read count = %d, index = %d, use = %d, msg = %s\n",
+                       readed, _msg.count, _msg.index, _msg.use, _msg.buf);
+
+       g_synbuf.reset_buf();
+       g_synbuf.write(_msg.buf, _msg.use);
+
+
+       ijcommand ijcmd;
+       readed = g_synbuf.read(ijcmd.cmd, ID_SIZE);
+
+       LOG("ij id : %s\n", ijcmd.cmd);
+
+       // TODO : check
+       if (readed < ID_SIZE)
+               return;
+
+       // read header
+       readed = g_synbuf.read((char*)&ijcmd.msg, HEADER_SIZE);
+       if (readed < HEADER_SIZE)
+               return;
+
+       int act = ijcmd.msg.action;
+       int grp = ijcmd.msg.group;
+       int len = ijcmd.msg.length;
+
+
+       LOG("HEADER : action = %d, group = %d, length = %d\n", act, grp, len);
+
+       if (ijcmd.msg.length > 0)
+       {
+               ijcmd.data = (char*) malloc(ijcmd.msg.length);
+               if (!ijcmd.data)
+               {
+                       LOG("failed to allocate memory\n");
+                       return;
+               }
+               readed = g_synbuf.read(ijcmd.data, ijcmd.msg.length);
+
+               LOG("DATA : %s\n", ijcmd.data);
+
+               if (readed < ijcmd.msg.length)
+               {
+                       LOG("received data is insufficient");
+                       //return;
+               }
+       }
+
+       process_evdi_command(&ijcmd);
+}
+
+bool server_process(void)
+{
+       int i,nfds;
+       int fd_tmp;
+
+       nfds = epoll_wait(g_epoll_fd, g_events, MAX_EVENTS, 100);
+
+       if (nfds == -1 && errno != EAGAIN && errno != EINTR)
+       {
+               fprintf(stderr, "epoll wait(%d)\n", errno);
+               return true;
+       }
+
+       for( i = 0 ; i < nfds ; i++ )
+       {
+               fd_tmp = g_events[i].data.fd;
+               if (fd_tmp == g_fd[fdtype_server])
+               {
+                       accept_proc(fd_tmp);
+               }
+               else if (fd_tmp == g_fd[fdtype_device])
+               {
+                       recv_from_evdi(fd_tmp);
+               }
+               else if(fd_tmp == g_fd[fdtype_vmodem])
+               {
+                       recv_from_vmodem(fd_tmp);
+               }
+               else
+               {
+                       recv_from_ij(fd_tmp);
+               }
+       }
+
+       return false;
+}
+/*------------------------------- end of function server_process */
+
+void end_server(int sig)
+{
+       close(g_fd[fdtype_server]); /* close server socket */
+       close(g_fd[fdtype_sensor]);
+       LOG("[SHUTDOWN] Server closed by signal %d",sig);
+
+       exit(0);
+}
+
+
+int main( int argc , char *argv[])
+{
+       int state;
+
+       if(log_print == 1)
+       {
+               // for emuld log file
+               systemcall("rm /var/log/emuld.log");
+               systemcall("touch /var/log/emuld.log");
+       }
+
+       LOG("start");
+       /* entry , argument check and process */
+       if(argc < 3){ 
+
+               g_svr_port = DEFAULT_PORT;
+
+       }else {
+
+               if(strcmp("-port",argv[1]) ==  0 ) {
+
+                       g_svr_port = atoi(argv[2]);
+                       if(g_svr_port < 1024) {
+                               fprintf(stderr, "[STOP] port number invalid : %d\n",g_svr_port);
+                               exit(0);
+                       } 
+               }
+       }
+
+       init_data0();   
+
+       if (!epoll_init())
+       {
+               exit(0);
+       }
+
+       if (!init_server0(g_svr_port, &g_fd[fdtype_server]))
+       {
+               close(g_epoll_fd);
+               exit(0);
+       }
+
+       if (!init_device(&g_fd[fdtype_device]))
+       {
+               close(g_epoll_fd);
+               exit(0);
+       }
+
+       LOG("[START] epoll events set success for server");
+
+       set_vm_connect_status(0);
+
+       if(pthread_create(&tid[0], NULL, init_vm_connect, NULL) != 0)
+       {
+               LOG("pthread create fail!");
+               close(g_epoll_fd);
+               exit(0);
+       }
+
+       udp_init();
+
+       bool is_exit = false;
+
+       while(!is_exit)
+       {
+               is_exit = server_process();
+       }
+
+       exit_flag = true;
+
+       if (!is_vm_connected())
+       {
+               int status;
+               pthread_join(tid[0], (void **)&status);
+               LOG("vmodem thread end %d\n", status);
+       }
+
+       state = pthread_mutex_destroy(&mutex_vmconnect);
+
+       stop_listen();
+
+       fprintf(stderr, "emuld exit\n");
+
+       return 0;
+}
+
diff --git a/src/emuld_proc.cpp b/src/emuld_proc.cpp
new file mode 100644 (file)
index 0000000..a043ee5
--- /dev/null
@@ -0,0 +1,881 @@
+/*
+ * emuld_proc.cpp
+ *
+ *  Created on: 2013. 4. 12.
+ *      Author: dykim
+ */
+
+#include "emuld_common.h"
+#include "emuld.h"
+#include "emuld_proc.h"
+#include <errno.h>
+
+#include <sys/mount.h>
+#include <stdio.h>
+#include <stdlib.h>
+#include <mntent.h>
+
+
+char SDpath[256];
+static struct timeval tv_start_poweroff;
+
+
+struct setting_device_param
+{
+       setting_device_param() : get_status_sockfd(-1), ActionID(0), is_evdi(false)
+       {
+               memset(type_cmd, 0, ID_SIZE);
+       }
+       int get_status_sockfd;
+       unsigned char ActionID;
+       bool is_evdi;
+       char type_cmd[ID_SIZE];
+};
+
+struct mount_param
+{
+       mount_param(int _fd) : fd(_fd), is_evdi(false) {}
+       int fd;
+       bool is_evdi;
+};
+
+
+
+char* get_mount_info() {
+       struct mntent *ent;
+       FILE *aFile;
+
+       aFile = setmntent("/proc/mounts", "r");
+       if (aFile == NULL) {
+               LOG("/proc/mounts is not exist");
+               return NULL;
+       }
+       char* mountinfo = new char[512];
+       memset(mountinfo, 0, 512);
+
+       while (NULL != (ent = getmntent(aFile))) {
+
+               if (strcmp(ent->mnt_dir, "/opt/storage/sdcard") == 0)
+               {
+                       LOG(",%s,%s,%d,%s,%d,%s\n",
+                                                       ent->mnt_fsname, ent->mnt_dir, ent->mnt_freq, ent->mnt_opts, ent->mnt_passno, ent->mnt_type);
+                       sprintf(mountinfo,",%s,%s,%d,%s,%d,%s\n",
+                                                       ent->mnt_fsname, ent->mnt_dir, ent->mnt_freq, ent->mnt_opts, ent->mnt_passno, ent->mnt_type);
+                       break;
+               }
+       }
+       endmntent(aFile);
+
+       return mountinfo;
+}
+
+int is_mounted()
+{
+       int ret = -1, i = 0;
+       struct stat buf;
+       char file_name[128];
+       memset(file_name, '\0', sizeof(file_name));
+
+       for(i = 0; i < 10; i++)
+       {
+               sprintf(file_name, "/dev/mmcblk%d", i);
+               ret = access(file_name, F_OK);
+               if( ret == 0 )
+               {
+                       lstat(file_name, &buf);
+                       if(S_ISBLK(buf.st_mode))
+                               return 1;
+                       else
+                               return 0;
+               }
+       }
+
+       return 0;
+}
+
+void* mount_sdcard(void* data)
+{
+       mount_param* param = (mount_param*) data;
+
+       int ret = -1, i = 0;
+       struct stat buf;
+       char file_name[128], command[256];
+       memset(file_name, '\0', sizeof(file_name));
+       memset(command, '\0', sizeof(command));
+
+       LXT_MESSAGE* packet = (LXT_MESSAGE*)malloc(sizeof(LXT_MESSAGE));
+       memset(packet, 0, sizeof(LXT_MESSAGE));
+
+       LOG("start sdcard mount thread");
+
+       pthread_detach(pthread_self());
+
+       while (ret < 0)
+       {
+               for (i = 0; i < 10; i++)
+               {
+                       sprintf(file_name, "/dev/mmcblk%d", i);
+                       ret = access( file_name, F_OK );
+                       if( ret == 0 )
+                       {
+                               lstat(file_name, &buf);
+                               if(!S_ISBLK(buf.st_mode))
+                               {
+                                       sprintf(command, "rm -rf %s", file_name);
+                                       systemcall(command);
+                               }
+                               else
+                                       break;
+                       }
+               }
+
+               if (i != 10)
+               {
+                       LOG( "%s is exist", file_name);
+                       packet->length = strlen(SDpath);                // length
+                       packet->group = 11;                             // sdcard
+                       if (ret == 0)
+                               packet->action = 1;     // mounted
+                       else
+                               packet->action = 5;     // failed
+
+                       //
+                       LOG("SDpath is %s", SDpath);
+
+                       const int tmplen = HEADER_SIZE + packet->length;
+                       char* tmp = (char*) malloc(tmplen);
+
+                       if (tmp)
+                       {
+                               memcpy(tmp, packet, HEADER_SIZE);
+                               if (packet->length > 0)
+                               {
+                                       memcpy(tmp + HEADER_SIZE, SDpath, packet->length);
+                               }
+
+                               if (param->is_evdi)
+                               {
+                                       ijmsg_send_to_evdi(g_fd[fdtype_device], IJTYPE_SDCARD, (const char*) tmp, tmplen);
+                               }
+                               else
+                               {
+                                       send_to_cli(param->fd, (char*) tmp, tmplen);
+                               }
+
+                               free(tmp);
+                       }
+
+                       //
+
+                       if (ret == 0) {
+                               //ret = system("/usr/bin/sys_event mmcblk_add");        // sdcard is not supported
+                       }
+
+                       break;
+               }
+               else
+               {
+                       LOG( "%s is not exist", file_name);
+                       sleep(1);
+               }
+       }
+
+       if(packet)
+       {
+           free(packet);
+           packet = NULL;
+       }
+
+       if (param)
+       {
+               delete param;
+               param = NULL;
+       }
+       pthread_exit((void *) 0);
+}
+
+int umount_sdcard(const int fd, bool is_evdi)
+{
+       int ret = -1, i = 0;
+       char file_name[128];
+       memset(file_name, '\0', sizeof(file_name));
+
+       LXT_MESSAGE* packet = (LXT_MESSAGE*)malloc(sizeof(LXT_MESSAGE));
+       if(packet == NULL){
+           return ret;
+       }
+       memset(packet, 0, sizeof(LXT_MESSAGE));
+
+       LOG("start sdcard umount");
+
+       pthread_cancel(tid[1]);
+
+       for (i = 0; i < 10; i++)
+       {
+               sprintf(file_name, "/dev/mmcblk%d", i);
+               ret = access(file_name, F_OK);
+               if (ret == 0)
+               {
+                       if(fd != -1)
+                       {
+                               packet->length = strlen(SDpath);                // length
+                               packet->group = 11;                             // sdcard
+                               packet->action = 0;                             // unmounted
+
+                               send(fd, (void*)packet, sizeof(char) * HEADER_SIZE, 0);
+
+                               LOG("SDpath is %s", SDpath);
+                               send(fd, SDpath, packet->length, 0);
+                       }
+                       else if (is_evdi)
+                       {
+                               LOG("SDpath is %s", SDpath);
+
+                               packet->length = strlen(SDpath);                // length
+                               packet->group = 11;                                             // sdcard
+                               packet->action = 0;                                             // unmounted
+
+                               const int tmplen = HEADER_SIZE + packet->length;
+                               char* tmp = (char*) malloc(tmplen);
+                               if (!tmp)
+                                       break;
+
+                               memcpy(tmp, packet, HEADER_SIZE);
+                               memcpy(tmp + HEADER_SIZE, SDpath, packet->length);
+
+                               ijmsg_send_to_evdi(g_fd[fdtype_device], IJTYPE_SDCARD, (const char*) tmp, tmplen);
+
+                               free(tmp);
+                       }
+
+                       memset(SDpath, '\0', sizeof(SDpath));
+                       sprintf(SDpath, "umounted");
+                       //ret = system("/usr/bin/sys_event mmcblk_remove");     // sdcard is not supported
+
+                       break;
+               }
+               else
+               {
+                       LOG( "%s is not exist", file_name);
+               }
+       }
+
+       if(packet){
+           free(packet);
+           packet = NULL;
+       }
+       return ret;
+}
+
+
+int powerdown_by_force(void)
+{
+       struct timeval now;
+       int poweroff_duration = POWEROFF_DURATION;
+
+       gettimeofday(&now, NULL);
+       /* Waiting until power off duration and displaying animation */
+       while (now.tv_sec - tv_start_poweroff.tv_sec < poweroff_duration) {
+               LOG("wait");
+               usleep(100000);
+               gettimeofday(&now, NULL);
+       }
+
+       LOG("Power off by force");
+       LOG("sync");
+
+       sync();
+
+       LOG("poweroff");
+
+       reboot(RB_POWER_OFF);
+
+       return 1;
+}
+
+// location event
+char command[512];
+char latitude[128];
+char longitude[128];
+void setting_location(char* databuf)
+{
+       char* s = strchr(databuf, ',');
+       memset(command, 0, 256);
+       if (s == NULL) { // SET MODE
+               int mode = atoi(databuf);
+               switch (mode) {
+               case 0: // STOP MODE
+                       sprintf(command, "vconftool set -t int db/location/replay/ReplayMode 0 -f");
+                       break;
+               case 1: // NMEA MODE (LOG MODE)
+                       sprintf(command, "vconftool set -t int db/location/replay/ReplayMode 1 -f");
+                       break;
+               case 2: // MANUAL MODE
+                       sprintf(command, "vconftool set -t int db/location/replay/ReplayMode 2 -f");
+                       break;
+               default:
+                       LOG("error(%s) : stop replay mode", databuf);
+                       sprintf(command, "vconftool set -t int db/location/replay/ReplayMode 0 -f");
+                       break;
+               }
+               LOG("Location Command : %s", command);
+               systemcall(command);
+       } else {
+               *s = '\0';
+               int mode = atoi(databuf);
+               if(mode == 1) { // NMEA MODE (LOG MODE)
+                       sprintf(command, "vconftool set -t string db/location/replay/FileName \"%s\"", s+1);
+                       LOG("%s", command);
+                       systemcall(command);
+                       memset(command, 0, 256);
+                       sprintf(command, "vconftool set -t int db/location/replay/ReplayMode 1 -f");
+                       LOG("%s", command);
+                       systemcall(command);
+               } else if(mode == 2) {
+                       memset(latitude,  0, 128);
+                       memset(longitude, 0, 128);
+                       char* t = strchr(s+1, ',');
+                       *t = '\0';
+                       strcpy(latitude, s+1);
+                       strcpy(longitude, t+1);
+                       //strcpy(longitude, s+1);
+                       //strcpy(latitude, databuf);
+                       // Latitude
+                       sprintf(command, "vconftool set -t double db/location/replay/ManualLatitude %s -f", latitude);
+                       LOG("%s", command);
+                       systemcall(command);
+
+                       // Longitude
+                       sprintf(command, "vconftool set -t double db/location/replay/ManualLongitude %s -f", longitude);
+                       LOG("%s", command);
+                       systemcall(command);
+               }
+       }
+}
+
+
+void* setting_device(void* data)
+{
+       pthread_detach(pthread_self());
+
+       setting_device_param* param = (setting_device_param*) data;
+
+       if (!param)
+               return 0;
+
+       int sockfd = param->get_status_sockfd;
+
+       bool is_evdi = param->is_evdi;
+
+       char* msg = 0;
+       LXT_MESSAGE* packet = (LXT_MESSAGE*)malloc(sizeof(LXT_MESSAGE));
+
+       switch(param->ActionID)
+       {
+       case BATTERY_LEVEL:
+               msg = get_battery_level((void*)packet, is_evdi);
+               if (msg == 0) {
+                       LOG("failed getting battery level");
+               }
+               break;
+       case BATTERY_CHARGER:
+               msg = get_battery_charger((void*)packet, is_evdi);
+               if (msg == 0) {
+                       LOG("failed getting battery charger state");
+               }
+               break;
+       case USB_STATUS:
+               msg = get_usb_status((void*)packet, is_evdi);
+               if (msg == 0) {
+                       LOG("failed getting usb status");
+               }
+               break;
+       case EARJACK_STATUS:
+               msg = get_earjack_status((void*)packet, is_evdi);
+               if (msg == 0) {
+                       LOG("failed getting earjack status");
+               }
+               break;
+       case RSSI_LEVEL:
+               msg = get_rssi_level((void*)packet, is_evdi);
+               if (msg == 0) {
+                       LOG("failed getting rssi level");
+               }
+               break;
+       case MOTION_VALUE:
+               LOG("not support getting motion value");
+               break;
+       case LOCATION_STATUS:
+               msg = get_location_status((void*)packet, is_evdi);
+               if (msg == 0) {
+                       LOG("failed getting location status");
+               }
+               break;
+       case NFC_STATUS:
+               msg = get_nfc_status((void*)packet, is_evdi);
+               if (msg ==0) {
+                       LOG("failed getting nfc status");
+               }
+               break;
+       case ACCEL_VALUE:
+               msg = get_acceleration_value((void*)packet, is_evdi);
+               if (msg == 0) {
+                       LOG("falied getting acceleration value");
+               }
+               break;
+       case GYRO_VALUE:
+               msg = get_gyroscope_value((void*)packet, is_evdi);
+               if (msg == 0) {
+                       LOG("failed getting gyroscope value");
+               }
+               break;
+       case MAG_VALUE:
+               msg = get_magnetic_value((void*)packet, is_evdi);
+               if (msg == 0) {
+                       LOG("failed getting magnetic value");
+               }
+               break;
+       case LIGHT_VALUE:
+               msg = get_light_level((void*)packet, is_evdi);
+               if (msg == 0) {
+                       LOG("failed getting light level");
+               }
+               break;
+       case PROXI_VALUE:
+               msg = get_proximity_status((void*)packet, is_evdi);
+               if (msg == 0) {
+                       LOG("failed getting proximity status");
+               }
+               break;
+       default:
+               //TODO
+       break;
+       }
+
+       if (sockfd != -1)
+       {
+               if (msg != 0)
+               {
+                       LOG("send data to injector");
+               }
+               else
+               {
+                       LOG("send error message to injector");
+                       memset(packet, 0, sizeof(LXT_MESSAGE));
+                       packet->length = 0;
+                       packet->group  = STATUS;
+                       packet->action = param->ActionID;
+               }
+
+               send(sockfd, (void*)packet, sizeof(char) * HEADER_SIZE, 0);
+
+               if (packet->length > 0)
+               {
+                       send(sockfd, msg, packet->length, 0);
+               }
+       }
+       else if (param->is_evdi)
+       {
+               if (msg == 0)
+               {
+                       LOG("send error message to injector");
+                       memset(packet, 0, sizeof(LXT_MESSAGE));
+                       packet->length = 0;
+                       packet->group = STATUS;
+                       packet->action = param->ActionID;
+               }
+               else
+               {
+                       LOG("send data to injector");
+               }
+
+               const int tmplen = HEADER_SIZE + packet->length;
+               char* tmp = (char*) malloc(tmplen);
+               if (tmp)
+               {
+                       memcpy(tmp, packet, HEADER_SIZE);
+                       if (packet->length > 0)
+                               memcpy(tmp + HEADER_SIZE, msg, packet->length);
+
+                       ijmsg_send_to_evdi(g_fd[fdtype_device], param->type_cmd, (const char*) tmp, tmplen);
+
+                       free(tmp);
+               }
+       }
+
+       if(msg != 0)
+       {
+               free(msg);
+               msg = 0;
+       }
+       if (packet)
+       {
+               free(packet);
+               packet = NULL;
+       }
+
+       if (param)
+               delete param;
+
+       pthread_exit((void *) 0);
+}
+
+
+// event injector message handlers
+
+bool msgproc_telephony(const int sockfd, ijcommand* ijcmd, const bool is_evdi)
+{
+       LOG("msgproc_telephony\n");
+
+       if (!is_vm_connected())
+               return false;
+
+       int sent;
+       sent = send(g_fd[fdtype_vmodem], &ijcmd->msg, HEADER_SIZE, 0);
+       if (sent == -1)
+       {
+               perror("vmodem send error");
+       }
+
+       LOG("sent to vmodem = %d, err = %d\n", sent, errno);
+
+       sent = send(g_fd[fdtype_vmodem], ijcmd->data, ijcmd->msg.length, 0);
+       if (sent == -1)
+       {
+               perror("vmodem send error");
+       }
+
+       LOG("sent to vmodem = %d, err = %d\n", sent, errno);
+
+       return true;
+}
+
+bool msgproc_sensor(const int sockfd, ijcommand* ijcmd, const bool is_evdi)
+{
+       LOG("msgproc_sensor\n");
+       int sslen = sizeof(si_sensord_other);
+
+       if (ijcmd->msg.group == STATUS)
+       {
+               setting_device_param* param = new setting_device_param();
+               if (!param)
+                       return false;
+
+               memset(param, 0, sizeof(param));
+
+               param->get_status_sockfd = sockfd;
+               param->ActionID = ijcmd->msg.action;
+               param->is_evdi = is_evdi;
+               memcpy(param->type_cmd, ijcmd->cmd, ID_SIZE);
+
+               if (pthread_create(&tid[2], NULL, setting_device, (void*)param) != 0)
+               {
+                       LOG("pthread create fail!");
+                       return false;
+               }
+
+       }
+       else if (sendto(g_fd[fdtype_sensor], ijcmd->data, ijcmd->msg.length, 0,
+                       (struct sockaddr*) &si_sensord_other, sslen) == -1)
+       {
+               LOG("sendto error!");
+               return false;
+       }
+       return true;
+}
+
+bool msgproc_location(const int sockfd, ijcommand* ijcmd, const bool is_evdi)
+{
+       LOG("msgproc_location\n");
+       if (ijcmd->msg.group == STATUS)
+       {
+               setting_device_param* param = new setting_device_param();
+               if (!param)
+                       return false;
+
+               param->get_status_sockfd = sockfd;
+               param->ActionID = ijcmd->msg.action;
+               param->is_evdi = is_evdi;
+               memcpy(param->type_cmd, ijcmd->cmd, ID_SIZE);
+
+               if (pthread_create(&tid[2], NULL, setting_device, (void*) param) != 0)
+               {
+                       LOG("pthread create fail!");
+                       return false;
+               }
+       }
+       else
+       {
+               setting_location(ijcmd->data);
+       }
+       return true;
+}
+
+bool msgproc_nfc(const int sockfd, ijcommand* ijcmd, const bool is_evdi)
+{
+       LOG("msgproc_nfc\n");
+
+       if (ijcmd->msg.group == STATUS)
+       {
+               setting_device_param* param = new setting_device_param();
+               if (!param)
+                       return false;
+
+               param->get_status_sockfd = sockfd;
+               param->ActionID = ijcmd->msg.action;
+               param->is_evdi = is_evdi;
+               memcpy(param->type_cmd, ijcmd->cmd, ID_SIZE);
+
+               if (pthread_create(&tid[2], NULL, setting_device, (void*) param) != 0)
+               {
+                       LOG("pthread create fail!");
+                       return false;
+               }
+       }
+       else
+       {
+               FILE* fd;
+               fd = fopen(PATH_NFC_DATA, "w");
+               if (!fd) {
+                       LOG("nfc file open fail!");
+                       return false;
+               }
+               fprintf(fd, "%s", ijcmd->data);
+               fclose(fd);
+       }
+       return true;
+}
+
+
+bool msgproc_system(const int sockfd, ijcommand* ijcmd, const bool is_evdi)
+{
+       LOG("msgproc_system\n");
+
+       LOG("/etc/rc.d/rc.shutdown, sync, reboot(RB_POWER_OFF)");
+
+       sync();
+
+       systemcall("/etc/rc.d/rc.shutdown &");
+
+
+       gettimeofday(&tv_start_poweroff, NULL);
+
+       powerdown_by_force();
+
+       return true;
+}
+
+
+
+bool msgproc_sdcard(const int sockfd, ijcommand* ijcmd, const bool is_evdi)
+{
+       LOG("msgproc_sdcard\n");
+
+       const int tmpsize = ijcmd->msg.length;
+
+       char token[] = "\n";
+       char tmpdata[tmpsize];
+       memcpy(tmpdata, ijcmd->data, tmpsize);
+
+       char* ret = NULL;
+       ret = strtok(tmpdata, token);
+
+       LOG("%s", ret);
+
+       int mount_val = atoi(ret);
+       int mount_status = 0;
+
+       switch (mount_val)
+       {
+               case 0:                                                 // umount
+                       {
+                               mount_status = umount_sdcard(sockfd, is_evdi);
+                               if (mount_status == 0)
+                                       send_guest_server(ijcmd->data);
+                       }
+                       break;
+               case 1:                                                 // mount
+                       {
+                               memset(SDpath, '\0', sizeof(SDpath));
+                               ret = strtok(NULL, token);
+                               strcpy(SDpath, ret);
+                               LOG("sdcard path is %s", SDpath);
+
+                               send_guest_server(ijcmd->data);
+
+                               mount_param* param = new mount_param(sockfd);
+                               if (!param)
+                                       break;
+
+                               param->is_evdi = is_evdi;
+
+                               if (pthread_create(&tid[1], NULL, mount_sdcard, (void*) param) != 0)
+                                       LOG("pthread create fail!");
+                       }
+
+                       break;
+               case 2:                                                 // mount status
+                       {
+                               mount_status = is_mounted();
+                               LXT_MESSAGE* mntData = (LXT_MESSAGE*) malloc(sizeof(LXT_MESSAGE));
+                               if (mntData == NULL)
+                               {
+                                       break;
+                               }
+                               memset(mntData, 0, sizeof(LXT_MESSAGE));
+
+                               mntData->length = strlen(SDpath);       // length
+                               mntData->group = 11;                    // sdcard
+
+                               LOG("SDpath is %s", SDpath);
+
+                               switch (mount_status)
+                               {
+                                       case 0:
+                                               {
+                                                       mntData->action = 2;                    // umounted status
+
+                                                       const int tmplen = HEADER_SIZE + mntData->length;
+                                                       char* tmp = (char*) malloc(tmplen);
+
+                                                       if (tmp)
+                                                       {
+                                                               memcpy(tmp, mntData, HEADER_SIZE);
+                                                               if (mntData->length > 0)
+                                                               {
+                                                                       memcpy(tmp + HEADER_SIZE, SDpath, mntData->length);
+                                                               }
+
+                                                               if (is_evdi)
+                                                               {
+                                                                       ijmsg_send_to_evdi(g_fd[fdtype_device], IJTYPE_SDCARD, (const char*) tmp, tmplen);
+                                                               }
+                                                               else
+                                                               {
+                                                                       send_to_cli(sockfd, (char*) tmp, tmplen);
+                                                               }
+
+                                                               free(tmp);
+                                                       }
+
+                                                       memset(SDpath, '\0', sizeof(SDpath));
+                                                       sprintf(SDpath, "umounted");
+                                               }
+                                               break;
+                                       case 1:
+                                               {
+                                                       mntData->action = 3;                    // mounted status
+
+                                                       int mountinfo_size = 0;
+                                                       char* mountinfo = get_mount_info();
+                                                       if (mountinfo)
+                                                       {
+                                                               mountinfo_size = strlen(mountinfo);
+                                                       }
+
+                                                       const int tmplen = HEADER_SIZE + mntData->length + mountinfo_size;
+                                                       char* tmp = (char*) malloc(tmplen);
+
+                                                       if (tmp)
+                                                       {
+                                                               memcpy(tmp, mntData, HEADER_SIZE);
+                                                               if (mntData->length > 0)
+                                                               {
+                                                                       memcpy(tmp + HEADER_SIZE, SDpath, mntData->length);
+                                                               }
+
+                                                               if (mountinfo)
+                                                               {
+                                                                       memcpy(tmp + HEADER_SIZE + mntData->length, mountinfo, mountinfo_size);
+                                                                       mntData->length += mountinfo_size;
+                                                                       memcpy(tmp, mntData, HEADER_SIZE);
+                                                                       delete mountinfo;
+                                                                       mountinfo = NULL;
+                                                               }
+
+                                                               if (is_evdi)
+                                                               {
+                                                                       ijmsg_send_to_evdi(g_fd[fdtype_device], IJTYPE_SDCARD, (const char*) tmp, tmplen);
+                                                               }
+                                                               else
+                                                               {
+                                                                       send_to_cli(sockfd, (char*) tmp, tmplen);
+                                                               }
+
+                                                               free(tmp);
+                                                       }
+                                               }
+                                               break;
+                                       default:
+                                               break;
+                               }
+                               free(mntData);
+                       }
+                       break;
+               default:
+                       LOG("unknown data %s", ret);
+                       break;
+       }
+       return true;
+}
+
+
+//sdcard event
+void send_guest_server(char* databuf)
+{
+       if (!databuf)
+       {
+               LOG("invalid data buf");
+               return;
+       }
+
+       char buf[32];
+       struct sockaddr_in si_other;
+       int s, slen=sizeof(si_other);
+       FILE* fd;
+       char fbuf[16];
+       int port = 3581;
+
+       fd = fopen(SDB_PORT_FILE, "r");
+       if(!fd)
+       {
+               LOG("fail to open %s file", SDB_PORT_FILE);
+       }
+
+       if (fgets(fbuf, 16, fd))
+       {
+               port = atoi(fbuf) + 3;
+       }
+       else
+       {
+               LOG("fgets failure\n");
+       }
+
+       fclose(fd);
+
+       s = socket(AF_INET, SOCK_DGRAM, IPPROTO_UDP);
+       if (s == -1)
+       {
+               LOG("socket error!");
+               return;
+       }
+
+       memset((char *) &si_other, 0, sizeof(si_other));
+       si_other.sin_family = AF_INET;
+       si_other.sin_port = htons(port);
+       if (inet_aton(SRV_IP, &si_other.sin_addr) == 0)
+       {
+                 fprintf(stderr, "inet_aton() failed\n");
+       }
+
+       memset(buf, '\0', sizeof(buf));
+       snprintf(buf, sizeof(buf), "4\n%s", databuf);
+       LOG("sendGuestServer msg: %s", buf);
+       if (sendto(s, buf, sizeof(buf), 0, (struct sockaddr*)&si_other, slen) == -1)
+       {
+               LOG("sendto error!");
+       }
+
+       close(s);
+}
+
diff --git a/src/evdi.cpp b/src/evdi.cpp
new file mode 100644 (file)
index 0000000..c92134a
--- /dev/null
@@ -0,0 +1,164 @@
+/*\r
+ * evdi.cpp\r
+ *\r
+ *  Created on: 2013. 4. 15.\r
+ *      Author: dykim\r
+ */\r
+\r
+#include "evdi.h"\r
+#include "emuld.h"\r
+\r
+#define DEVICE_NODE_PATH       "/dev/evdi0"\r
+\r
+\r
+static pthread_mutex_t mutex_evdi = PTHREAD_MUTEX_INITIALIZER;\r
+\r
+\r
+evdi_fd open_device(void)\r
+{\r
+       evdi_fd fd;\r
+\r
+       fd = open(DEVICE_NODE_PATH, O_RDWR); //O_CREAT|O_WRONLY|O_TRUNC.\r
+       printf("evdi open fd is %d", fd);\r
+\r
+       if (fd <= 0) {\r
+               printf("open %s fail", DEVICE_NODE_PATH);\r
+               return fd;\r
+       }\r
+\r
+       return fd;\r
+}\r
+\r
+\r
+bool set_nonblocking(evdi_fd fd)\r
+{\r
+    int opts;\r
+    opts= fcntl(fd, F_GETFL);\r
+    if (opts < 0)\r
+    {\r
+        perror("fcntl failed\n");\r
+        return false;\r
+    }\r
+    opts = opts | O_NONBLOCK;\r
+    if (fcntl(fd, F_SETFL, opts) < 0)\r
+    {\r
+        perror("fcntl failed\n");\r
+        return false;\r
+    }\r
+    return true;\r
+}\r
+\r
+\r
+bool init_device(evdi_fd* ret_fd)\r
+{\r
+       evdi_fd fd;\r
+\r
+       *ret_fd = -1;\r
+\r
+       fd = open_device();\r
+       if (fd <= 0)\r
+               return false;\r
+\r
+       if (!set_nonblocking(fd))\r
+       {\r
+               close(fd);\r
+               return false;\r
+       }\r
+\r
+       if (!epoll_ctl_add(fd))\r
+       {\r
+               fprintf(stderr, "Epoll control fails.\n");\r
+               close(fd);\r
+               return false;\r
+       }\r
+\r
+       *ret_fd = fd;\r
+\r
+       return true;\r
+}\r
+\r
+\r
+bool send_to_evdi(evdi_fd fd, const char* data, const int len)\r
+{\r
+       printf("send to evdi client, len = %d\n", len);\r
+       int ret;\r
+\r
+       ret = write(fd, data, len);\r
+\r
+       printf("written bytes = %d\n", ret);\r
+\r
+       if (ret == -1)\r
+               return false;\r
+       return true;\r
+}\r
+\r
+bool ijmsg_send_to_evdi(evdi_fd fd, const char* cat, const char* data, const int len)\r
+{\r
+       _auto_mutex _(&mutex_evdi);\r
+\r
+       LOG("ijmsg_send_to_evdi\n");\r
+\r
+       if (fd == -1)\r
+               return false;\r
+\r
+       char tmp[ID_SIZE];\r
+       memset(tmp, 0, ID_SIZE);\r
+       strncpy(tmp, cat, 10);\r
+\r
+       // TODO: need to make fragmented transmission\r
+       if (len + ID_SIZE > __MAX_BUF_SIZE) {\r
+               LOG("evdi message len is too large\n");\r
+               return false;\r
+       }\r
+\r
+       msg_info _msg;\r
+       memset(_msg.buf, 0, __MAX_BUF_SIZE);\r
+       memcpy(_msg.buf, tmp, ID_SIZE);\r
+       memcpy(_msg.buf + ID_SIZE, data, len);\r
+\r
+       _msg.route = route_control_server;\r
+       _msg.use = len + ID_SIZE;\r
+       _msg.count = 1;\r
+       _msg.index = 0;\r
+       _msg.cclisn = 0;\r
+\r
+       LOG("ijmsg_send_to_evdi - %s", _msg.buf);\r
+\r
+       if (!send_to_evdi(fd, (char*) &_msg, sizeof(_msg)))\r
+               return false;\r
+\r
+       return true;\r
+}\r
+\r
+bool msg_send_to_evdi(evdi_fd fd, const char* data, const int len)\r
+{\r
+       _auto_mutex _(&mutex_evdi);\r
+\r
+       // TODO: need to make fragmented transmission\r
+       if (len > __MAX_BUF_SIZE)\r
+       {\r
+               LOG("evdi message len is too large\n");\r
+               return false;\r
+       }\r
+\r
+       msg_info _msg;\r
+       memset(_msg.buf, 0, __MAX_BUF_SIZE);\r
+       memcpy(_msg.buf, data, len);\r
+\r
+       _msg.route = route_control_server;\r
+       _msg.use = len;\r
+       _msg.count = 1;\r
+       _msg.index = 0;\r
+       _msg.cclisn = 0;\r
+\r
+       LOG("msg_send_to_evdi - %s", _msg.buf);\r
+\r
+       if (!send_to_evdi(fd, (char*)&_msg, sizeof(_msg)))\r
+               return false;\r
+\r
+       return true;\r
+}\r
+\r
+\r
+\r
+\r
diff --git a/src/get_status.c b/src/get_status.c
deleted file mode 100644 (file)
index fb033d1..0000000
+++ /dev/null
@@ -1,397 +0,0 @@
-/*
- * emulator-daemon
- *
- * Copyright (c) 2000 - 2011 Samsung Electronics Co., Ltd. All rights reserved.
- *
- * Contact:
- * SooYoung Ha <yoosah.ha@samsnung.com>
- * Sungmin Ha <sungmin82.ha@samsung.com>
- * YeongKyoon Lee <yeongkyoon.lee@samsung.com>
- * 
- * Licensed under the Apache License, Version 2.0 (the "License");
- * you may not use this file except in compliance with the License.
- * You may obtain a copy of the License at
- *
- * http://www.apache.org/licenses/LICENSE-2.0
- *
- * Unless required by applicable law or agreed to in writing, software
- * distributed under the License is distributed on an "AS IS" BASIS,
- * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
- * See the License for the specific language governing permissions and
- * limitations under the License.
- * 
- * Contributors:
- * - S-Core Co., Ltd
- *
- */
-
-//#include <vconf.h>
-#include "emuld_common.h"
-
-
-char* message;
-char* get_usb_status(void* p)
-{
-       FILE* fd = fopen("/sys/devices/platform/jack/usb_online", "r");
-       if(!fd)
-       {
-               return 0;
-       }
-
-       int status = 0;
-       fscanf(fd, "%d", &status);
-       fclose(fd);
-
-       // int to byte
-       message = (char*)malloc(5);
-       message[3] = (char) (status & 0xff);
-       message[2] = (char) (status >> 8 & 0xff);
-       message[1] = (char) (status >> 16 & 0xff);
-       message[0] = (char) (status >> 24 & 0xff);
-       message[4] = '\0';
-
-       LXT_MESSAGE* packet = p;
-       memset(packet, 0, sizeof(LXT_MESSAGE));
-       packet->length = 4;
-       packet->group  = STATUS;
-       packet->action = USB_STATUS;
-
-       return message;
-}
-
-char* get_earjack_status(void* p)
-{
-       FILE* fd = fopen("/sys/devices/platform/jack/earjack_online", "r");
-       if(!fd)
-       {
-               return 0;
-       }
-
-       int status = 0;
-       fscanf(fd, "%d", &status);
-       fclose(fd);
-
-       // int to byte
-       message = (char*)malloc(5);
-       message[3] = (char) (status & 0xff);
-       message[2] = (char) (status >> 8 & 0xff);
-       message[1] = (char) (status >> 16 & 0xff);
-       message[0] = (char) (status >> 24 & 0xff);
-       message[4] = '\0';
-
-       LXT_MESSAGE* packet = p;
-       memset(packet, 0, sizeof(LXT_MESSAGE));
-       packet->length = 4;
-       packet->group  = STATUS;
-       packet->action = EARJACK_STATUS;
-
-       return message;
-}
-
-char* get_rssi_level(void* p)
-{
-       int level;
-       int ret = vconf_get_int("memory/telephony/rssi", &level);
-       if (ret != 0) {
-               return 0;
-       }
-
-       // int to byte
-       message = (char*)malloc(5);
-       message[3] = (char) (level & 0xff);
-       message[2] = (char) (level >> 8 & 0xff);
-       message[1] = (char) (level >> 16 & 0xff);
-       message[0] = (char) (level >> 24 & 0xff);
-       message[4] = '\0';
-
-       LXT_MESSAGE* packet = p;
-       memset(packet, 0, sizeof(LXT_MESSAGE));
-       packet->length = 4;
-       packet->group  = STATUS;
-       packet->action = RSSI_LEVEL;
-
-       return message;
-}
-
-char* get_battery_level(void* p)
-{
-       FILE* fd = fopen("/sys/class/power_supply/battery/capacity", "r");
-       if(!fd)
-       {
-               return 0;
-       }
-
-       int level = 0;
-       fscanf(fd, "%d", &level);
-       fclose(fd);
-
-       // int to byte
-       message = (char*)malloc(5);
-       message[3] = (char) (level & 0xff);
-       message[2] = (char) (level >> 8 & 0xff);
-       message[1] = (char) (level >> 16 & 0xff);
-       message[0] = (char) (level >> 24 & 0xff);
-       message[4] = '\0';
-
-       LXT_MESSAGE* packet = p;
-       memset(packet, 0, sizeof(LXT_MESSAGE));
-       packet->length = 4;
-       packet->group  = STATUS;
-       packet->action = BATTERY_LEVEL;
-
-       return message;
-}
-
-char* get_battery_charger(void* p)
-{
-       FILE* fd = fopen("/sys/class/power_supply/battery/charge_now", "r");
-       if(!fd)
-       {
-               return 0;
-       }
-
-       int charge = 0;
-       fscanf(fd, "%d", &charge);
-       fclose(fd);
-       // int to byte
-       message = (char*)malloc(5);
-
-       message[3] = (char) (charge & 0xff);
-       message[2] = (char) (charge >> 8 & 0xff);
-       message[1] = (char) (charge >> 16 & 0xff);
-       message[0] = (char) (charge >> 24 & 0xff);
-       message[4] = '\0';
-       
-       LXT_MESSAGE* packet = p;        
-       memset(packet, 0, sizeof(LXT_MESSAGE));
-       packet->length = 4;
-       packet->group  = STATUS;
-       packet->action = BATTERY_CHARGER;
-
-       return message;
-}
-
-char* get_proximity_status(void* p)
-{
-       FILE* fd = fopen("/opt/sensor/proxi/vo", "r");
-       if(!fd)
-       {
-               return 0;
-       }
-
-       int status = 0;
-       fscanf(fd, "%d", &status);
-       fclose(fd);
-       // int to byte
-       message = (char*)malloc(5);
-
-       message[3] = (char) (status & 0xff);
-       message[2] = (char) (status >> 8 & 0xff);
-       message[1] = (char) (status >> 16 & 0xff);
-       message[0] = (char) (status >> 24 & 0xff);
-       message[4] = '\0';
-       
-       LXT_MESSAGE* packet = p;        
-       memset(packet, 0, sizeof(LXT_MESSAGE));
-       packet->length = 4;
-       packet->group  = STATUS;
-       packet->action = PROXI_VALUE;
-
-       return message;
-}
-
-char* get_light_level(void* p)
-{
-       FILE* fd = fopen("/opt/sensor/light/adc", "r");
-       if(!fd)
-       {
-               return 0;
-       }
-
-       int level = 0;
-       fscanf(fd, "%d", &level);
-       fclose(fd);
-
-       // int to byte
-       message = (char*)malloc(5);
-       message[3] = (char) (level & 0xff);
-       message[2] = (char) (level >> 8 & 0xff);
-       message[1] = (char) (level >> 16 & 0xff);
-       message[0] = (char) (level >> 24 & 0xff);
-       message[4] = '\0';
-
-       LXT_MESSAGE* packet = p;
-       memset(packet, 0, sizeof(LXT_MESSAGE));
-       packet->length = 4;
-       packet->group  = STATUS;
-       packet->action = LIGHT_VALUE;
-
-       return message;
-}
-
-char* get_acceleration_value(void* p)
-{
-       FILE* fd = fopen("/opt/sensor/accel/xyz", "r");
-       if(!fd)
-       {
-               return 0;
-       }
-
-       message = (char*)malloc(128);
-       //fscanf(fd, "%d, %d, %d", message);
-       fgets(message, 128, fd);
-       fclose(fd);
-
-       LXT_MESSAGE* packet = p;
-       memset(packet, 0, sizeof(LXT_MESSAGE));
-       packet->length = strlen(message);
-       packet->group  = STATUS;
-       packet->action = ACCEL_VALUE;
-
-       return message;
-}
-
-char* get_gyroscope_value(void* p)
-{
-       int x;
-       int y;
-       int z;
-       FILE* fd = fopen("/opt/sensor/gyro/gyro_x_raw", "r");
-       if(!fd)
-       {
-               return 0;
-       }
-       fscanf(fd, "%d", &x);
-       fclose(fd);
-
-       fd = fopen("/opt/sensor/gyro/gyro_y_raw", "r");
-       if(!fd)
-       {
-               return 0;
-       }
-       fscanf(fd, "%d", &y);
-       fclose(fd);
-
-       fd = fopen("/opt/sensor/gyro/gyro_z_raw", "r");
-       if(!fd)
-       {
-               return 0;
-       }
-       fscanf(fd, "%d", &z);
-       fclose(fd);
-       message = (char*)malloc(128);
-       memset(message, 0, 128);
-       int ret = sprintf(message, "%d, %d, %d", x, y, z);      
-       if (ret < 0) {
-               free(message);
-               return 0;
-       }
-
-       LXT_MESSAGE* packet = p;
-       memset(packet, 0, sizeof(LXT_MESSAGE));
-       packet->length = strlen(message);
-       packet->group  = STATUS;
-       packet->action = GYRO_VALUE;
-
-       return message;
-}
-
-char* get_magnetic_value(void* p)
-{
-       FILE* fd = fopen("/opt/sensor/geo/tesla", "r");
-       if(!fd)
-       {
-               return 0;
-       }
-
-       message = (char*)malloc(128);
-       fgets(message, 128, fd);
-       fclose(fd);
-
-       LXT_MESSAGE* packet = p;
-       memset(packet, 0, sizeof(LXT_MESSAGE));
-       packet->length = strlen(message);
-       packet->group  = STATUS;
-       packet->action = MAG_VALUE;
-       return message;
-}
-
-char* get_location_status(void* p)
-{
-       int mode;
-       int ret = vconf_get_int("db/location/replay/ReplayMode", &mode);
-       if (ret != 0) {
-               return 0;
-       }
-
-       if (mode == 0) { // STOP
-               message = (char*)malloc(5);
-               ret = sprintf(message, "%d", mode);
-               if (ret < 0) {
-                       free(message);
-                       return 0;
-               }
-       } else if (mode == 1) { // NMEA MODE(LOG MODE)
-               //char* temp = (char*)malloc(128);
-               char* temp = 0;
-               temp = vconf_get_str("db/location/replay/FileName");
-               if (temp == 0) {
-                       //free(temp);
-                       return 0;
-               }
-
-               message = (char*)malloc(256);
-               ret = sprintf(message, "%d,%s", mode, temp);
-               if (ret < 0) {
-                       free(message);
-                       return 0;
-               }
-       } else if (mode == 2) { // MANUAL MODE
-               double latitude;
-               double logitude;
-               ret = vconf_get_dbl("db/location/replay/ManualLatitude", &latitude);
-               if (ret != 0) {
-                       return 0;
-               }
-               ret = vconf_get_dbl("db/location/replay/ManualLongitude", &logitude);
-               if (ret != 0) {
-                       return 0;
-               }
-               message = (char*)malloc(128);
-               ret = sprintf(message, "%d,%f,%f", mode, latitude, logitude);
-               if (ret < 0) {
-                       free(message);
-                       return 0;
-               }
-       }
-
-       LXT_MESSAGE* packet = p;
-       memset(packet, 0, sizeof(LXT_MESSAGE));
-       packet->length = strlen(message);
-       packet->group  = STATUS;
-       packet->action = LOCATION_STATUS;
-
-       return message;
-}
-
-char* get_nfc_status(void* p)
-{
-       FILE* fd = fopen("/opt/nfc/sdkMsg", "r");
-       if(!fd)
-       {
-               return 0;
-       }
-
-       message = (char*)malloc(5000);
-       fscanf(fd, "%s\n", message);
-       fclose(fd);
-
-       LXT_MESSAGE* packet = p;
-       memset(packet, 0, sizeof(LXT_MESSAGE));
-       packet->length = strlen(message);
-       packet->group  = STATUS;
-       packet->action = NFC_STATUS;
-
-       return message;
-}
diff --git a/src/get_status.cpp b/src/get_status.cpp
new file mode 100644 (file)
index 0000000..6c75ed1
--- /dev/null
@@ -0,0 +1,402 @@
+/*
+ * emulator-daemon
+ *
+ * Copyright (c) 2000 - 2011 Samsung Electronics Co., Ltd. All rights reserved.
+ *
+ * Contact:
+ * SooYoung Ha <yoosah.ha@samsnung.com>
+ * Sungmin Ha <sungmin82.ha@samsung.com>
+ * YeongKyoon Lee <yeongkyoon.lee@samsung.com>
+ * 
+ * Licensed under the Apache License, Version 2.0 (the "License");
+ * you may not use this file except in compliance with the License.
+ * You may obtain a copy of the License at
+ *
+ * http://www.apache.org/licenses/LICENSE-2.0
+ *
+ * Unless required by applicable law or agreed to in writing, software
+ * distributed under the License is distributed on an "AS IS" BASIS,
+ * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
+ * See the License for the specific language governing permissions and
+ * limitations under the License.
+ * 
+ * Contributors:
+ * - S-Core Co., Ltd
+ *
+ */
+
+
+#include "emuld_common.h"
+#include <vconf/vconf.h>
+#include <vconf/vconf-keys.h>
+
+
+static int inline get_message(char* message, int status, int buf_len, bool is_evdi)
+{
+       if (is_evdi) {
+               sprintf(message, "%d", status);
+               return strlen(message);
+       } else {
+               // int to byte
+               message[3] = (char) (status & 0xff);
+               message[2] = (char) (status >> 8 & 0xff);
+               message[1] = (char) (status >> 16 & 0xff);
+               message[0] = (char) (status >> 24 & 0xff);
+               message[4] = '\0';
+       }
+
+       return 4;       
+}
+
+static int inline get_status(const char* filename)
+{
+       int ret;
+       int status = 0;
+       FILE* fd = fopen(filename, "r");
+       if(!fd)
+               return -1;
+
+       ret = fscanf(fd, "%d", &status);
+       fclose(fd);
+       
+       if (ret < 0) {
+               return ret;
+       }
+
+       return status;
+}
+
+static int inline get_file_status(char* msg, const char* filename, int buf_len, bool is_evdi)
+{
+       int status = get_status(filename);
+       if (status < 0)
+               return status;
+       return get_message(msg, status, buf_len, is_evdi);
+}
+
+static int inline get_vconf_status(char* msg, const char* key, int buf_len, bool is_evdi)
+{
+       int status;
+       int ret = vconf_get_int(key, &status);
+       if (ret != 0) {
+               //LOG("cannot get vconf key - %s", key);
+               return -1;
+       }
+
+       return get_message(msg, status, buf_len, is_evdi);
+}
+
+char* __tmpalloc(const int size)
+{
+       char* message = (char*)malloc(sizeof(char) * size);
+       memset(message, 0, sizeof(char) * size);
+       return message;
+}
+
+char* get_usb_status(void* p, bool is_evdi)
+{
+       char* message = __tmpalloc(5);
+       int length = get_file_status(message, "/sys/devices/platform/jack/usb_online", 5, is_evdi);
+       if (length < 0){
+               //LOG("get usb status error - %d", length);
+               length = 0;
+       }
+
+       LXT_MESSAGE* packet = (LXT_MESSAGE*)p;
+       memset(packet, 0, sizeof(LXT_MESSAGE));
+       packet->length = length;
+       packet->group  = STATUS;
+       packet->action = USB_STATUS;
+
+       return message;
+}
+
+char* get_earjack_status(void* p, bool is_evdi)
+{
+       char* message = __tmpalloc(5);
+       int length = get_file_status(message, "/sys/devices/platform/jack/earjack_online", 5, is_evdi);
+       if (length < 0){
+               return 0;
+       }
+
+       LXT_MESSAGE* packet = (LXT_MESSAGE*)p;
+       memset(packet, 0, sizeof(LXT_MESSAGE));
+       packet->length = length;
+       packet->group  = STATUS;
+       packet->action = EARJACK_STATUS;
+
+       return message;
+}
+
+char* get_rssi_level(void* p, bool is_evdi)
+{
+       char* message = __tmpalloc(5);
+       int length = get_vconf_status(message, "memory/telephony/rssi", 5, is_evdi);
+       if (length < 0){
+               return 0;
+       }
+
+       LXT_MESSAGE* packet = (LXT_MESSAGE*)p;
+       memset(packet, 0, sizeof(LXT_MESSAGE));
+       packet->length = length;
+       packet->group  = STATUS;
+       packet->action = RSSI_LEVEL;
+
+       return message;
+}
+
+char* get_battery_level(void* p, bool is_evdi)
+{
+       char* message = __tmpalloc(5);
+       int length = get_file_status(message, "/sys/class/power_supply/battery/capacity", 5, is_evdi);
+       if (length < 0){
+               return 0;
+       }
+
+       LXT_MESSAGE* packet = (LXT_MESSAGE*)p;
+       memset(packet, 0, sizeof(LXT_MESSAGE));
+       packet->length = length;
+       packet->group  = STATUS;
+       packet->action = BATTERY_LEVEL;
+
+       return message;
+}
+
+char* get_battery_charger(void* p, bool is_evdi)
+{
+       char* message = __tmpalloc(5);
+       int length = get_file_status(message, "/sys/class/power_supply/battery/charge_now", 5, is_evdi);
+       if (length < 0){
+               return 0;
+       }
+       
+       LXT_MESSAGE* packet = (LXT_MESSAGE*)p;
+       memset(packet, 0, sizeof(LXT_MESSAGE));
+       packet->length = length;
+       packet->group  = STATUS;
+       packet->action = BATTERY_CHARGER;
+
+       return message;
+}
+
+char* get_proximity_status(void* p, bool is_evdi)
+{
+       char* message = __tmpalloc(5);
+       int length = get_file_status(message, PATH_SENSOR_PROXI_VO, 5, is_evdi);
+       if (length < 0){
+               return 0;
+       }
+
+       LXT_MESSAGE* packet = (LXT_MESSAGE*)p;
+       memset(packet, 0, sizeof(LXT_MESSAGE));
+       packet->length = length;
+       packet->group  = STATUS;
+       packet->action = PROXI_VALUE;
+
+       return message;
+}
+
+char* get_light_level(void* p, bool is_evdi)
+{
+       char* message = __tmpalloc(6);
+       int length = get_file_status(message, PATH_SENSOR_LIGHT_ADC, 6, is_evdi);
+       if (length < 0){
+               return 0;
+       }
+
+       LXT_MESSAGE* packet = (LXT_MESSAGE*)p;
+       memset(packet, 0, sizeof(LXT_MESSAGE));
+       packet->length = length;
+       packet->group  = STATUS;
+       packet->action = LIGHT_VALUE;
+
+       return message;
+}
+
+char* get_acceleration_value(void* p, bool is_evdi)
+{
+       FILE* fd = fopen(PATH_SENSOR_ACCEL_XYZ, "r");
+       if(!fd)
+       {
+               return 0;
+       }
+
+       char* message = __tmpalloc(128);
+
+       //fscanf(fd, "%d, %d, %d", message);
+       if (!fgets(message, 128, fd))
+               fprintf(stderr, "fgets failure");
+
+       fclose(fd);
+
+       LXT_MESSAGE* packet = (LXT_MESSAGE*)p;
+       memset(packet, 0, sizeof(LXT_MESSAGE));
+       packet->length = strlen(message);
+       packet->group  = STATUS;
+       packet->action = ACCEL_VALUE;
+
+       return message;
+}
+
+char* get_gyroscope_value(void* p, bool is_evdi)
+{
+       int x, y, z;
+       int ret;
+
+       FILE* fd = fopen(PATH_SENSOR_GYRO_X_RAW, "r");
+       if(!fd)
+       {
+               return 0;
+       }
+       ret = fscanf(fd, "%d", &x);
+       fclose(fd);
+
+       fd = fopen(PATH_SENSOR_GYRO_Y_RAW, "r");
+       if(!fd)
+       {
+               return 0;
+       }
+       ret = fscanf(fd, "%d", &y);
+       fclose(fd);
+
+       fd = fopen(PATH_SENSOR_GYRO_Z_RAW, "r");
+       if(!fd)
+       {
+               return 0;
+       }
+       ret = fscanf(fd, "%d", &z);
+       fclose(fd);
+
+       char* message = __tmpalloc(128);
+
+       ret = sprintf(message, "%d, %d, %d", x, y, z);
+       if (ret < 0) {
+               free(message);
+               message = 0;
+               return 0;
+       }
+
+       LXT_MESSAGE* packet = (LXT_MESSAGE*)p;
+       memset(packet, 0, sizeof(LXT_MESSAGE));
+       packet->length = strlen(message);
+       packet->group  = STATUS;
+       packet->action = GYRO_VALUE;
+
+       return message;
+}
+
+char* get_magnetic_value(void* p, bool is_evdi)
+{
+       FILE* fd = fopen(PATH_SENSOR_GEO_TESLA, "r");
+       if(!fd)
+       {
+               return 0;
+       }
+
+       char* message = __tmpalloc(128);
+       if (!fgets(message, 128, fd))
+       {
+               fprintf(stderr, "fgets failure");
+       }
+       fclose(fd);
+
+       LXT_MESSAGE* packet = (LXT_MESSAGE*)p;
+       memset(packet, 0, sizeof(LXT_MESSAGE));
+       packet->length = strlen(message);
+       packet->group  = STATUS;
+       packet->action = MAG_VALUE;
+       return message;
+}
+
+char* get_location_status(void* p, bool is_evdi)
+{
+       int mode;
+       int ret = vconf_get_int("db/location/replay/ReplayMode", &mode);
+       if (ret != 0) {
+               return 0;
+       }
+
+       char* message = 0;
+
+       if (mode == 0)
+       { // STOP
+               message = (char*)malloc(5);
+               memset(message, 0, 5);
+
+               ret = sprintf(message, "%d", mode);
+               if (ret < 0) {
+                       free(message);
+                       message = 0;
+                       return 0;
+               }
+       }
+       else if (mode == 1)
+       { // NMEA MODE(LOG MODE)
+               char* temp = 0;
+               temp = (char*) vconf_get_str("db/location/replay/FileName");
+               if (temp == 0) {
+                       //free(temp);
+                       return 0;
+               }
+
+               message = (char*)malloc(256);
+               memset(message, 0, 256);
+               ret = sprintf(message, "%d,%s", mode, temp);
+               if (ret < 0) {
+                       free(message);
+                       message = 0;
+                       return 0;
+               }
+       } else if (mode == 2) { // MANUAL MODE
+               double latitude;
+               double logitude;
+               ret = vconf_get_dbl("db/location/replay/ManualLatitude", &latitude);
+               if (ret != 0) {
+                       return 0;
+               }
+               ret = vconf_get_dbl("db/location/replay/ManualLongitude", &logitude);
+               if (ret != 0) {
+                       return 0;
+               }
+               message = (char*)malloc(128);
+               memset(message, 0, 128);
+               ret = sprintf(message, "%d,%f,%f", mode, latitude, logitude);
+               if (ret < 0) {
+                       free(message);
+                       message = 0;
+                       return 0;
+               }
+       }
+
+       LXT_MESSAGE* packet = (LXT_MESSAGE*)p;
+       memset(packet, 0, sizeof(LXT_MESSAGE));
+       packet->length = strlen(message);
+       packet->group  = STATUS;
+       packet->action = LOCATION_STATUS;
+
+       return message;
+}
+
+char* get_nfc_status(void* p, bool is_evdi)
+{
+       int ret;
+       FILE* fd = fopen(PATH_NFC_DATA, "r");
+       if(!fd)
+       {
+               return 0;
+       }
+
+       char* message = __tmpalloc(5000);
+       ret = fscanf(fd, "%s\n", message);
+       fclose(fd);
+
+       LXT_MESSAGE* packet = (LXT_MESSAGE*)p;
+       memset(packet, 0, sizeof(LXT_MESSAGE));
+       packet->length = strlen(message);
+       packet->group  = STATUS;
+       packet->action = NFC_STATUS;
+
+       return message;
+}
+
+
diff --git a/src/log.cpp b/src/log.cpp
new file mode 100644 (file)
index 0000000..5391d88
--- /dev/null
@@ -0,0 +1,89 @@
+
+#include <stdio.h>
+#include <stdlib.h>
+#include <stdarg.h>
+#include <time.h>
+#include "log.h"
+
+#define EMD_DEBUG
+
+struct emuld_log
+{
+       emuld_log()
+       {
+               m_isLogout = false;
+
+               char* buf = getenv("EMULD_LOG");
+               if (buf != NULL) {
+                       fprintf(stdout, "env EMULD_LOG is set => print logs \n");
+                       m_isLogout = true;
+               }
+       }
+
+       void out_v(const char *fmt, ...)
+       {
+               if (m_isLogout)
+               {
+                       char buf[4096];
+                       va_list ap;
+
+                       va_start(ap, fmt);
+                       vsnprintf(buf, sizeof(buf), fmt, ap);
+                       va_end(ap);
+
+                       fprintf(stdout, "%s", buf);
+                       FILE* log_fd = fopen("/var/log/emuld.log", "a");
+                       fprintf(log_fd, "%s", buf);
+                       fclose(log_fd);
+               }
+       }
+
+       void out(const char* outbuf)
+               {
+                       if (!m_isLogout)
+                               return;
+
+                       char timestr[512];
+                       make_timestamp(timestr);
+                       fprintf(stdout, "%s - %s", timestr, outbuf);
+                       FILE* log_fd = fopen("/var/log/emuld.log", "a");
+                       fprintf(log_fd, "%s - %s", timestr, outbuf);
+                       fclose(log_fd);
+               }
+
+       bool m_isLogout;
+};
+
+
+static emuld_log g_log;
+
+void log_print_out(const char *fmt, ...)
+{
+
+#ifdef EMD_DEBUG
+
+       char buf[4096];
+       va_list ap;
+
+       va_start(ap, fmt);
+       vsnprintf(buf, sizeof(buf), fmt, ap);
+       va_end(ap);
+
+       g_log.out(buf);
+#endif
+
+       return;
+}
+
+void make_timestamp(char* ret)
+{
+    time_t ltime;
+    ltime = time(NULL);
+
+    struct tm* ts;
+    ts = localtime(&ltime);
+
+    strftime(ret, 512, "%a_%Y-%m-%d_%H-%M-%S", ts);
+}
+
+