From: Denis Kenzior <denkenz@gmail.com>
Date: Wed, 28 Apr 2010 14:49:58 +0000 (-0500)
Subject: gathdlc: Add recording support, ported from PPP
X-Git-Tag: 0.21~201
X-Git-Url: http://review.tizen.org/git/?a=commitdiff_plain;h=5acb633a1dd67bd4e61b083ad3f3c0a1a8fbc1f2;p=platform%2Fupstream%2Fofono.git

gathdlc: Add recording support, ported from PPP

For protocol examination using wireshark
---

diff --git a/gatchat/gathdlc.c b/gatchat/gathdlc.c
index 06deb2d..9520ff8 100644
--- a/gatchat/gathdlc.c
+++ b/gatchat/gathdlc.c
@@ -23,6 +23,13 @@
 #include <config.h>
 #endif
 
+#include <arpa/inet.h>
+#include <sys/time.h>
+#include <sys/types.h>
+#include <sys/stat.h>
+#include <fcntl.h>
+#include <stdio.h>
+#include <unistd.h>
 #include <glib.h>
 
 #include "crc-ccitt.h"
@@ -59,8 +66,50 @@ struct _GAtHDLC {
 	gpointer receive_data;
 	GAtDebugFunc debugf;
 	gpointer debug_data;
+	int record_fd;
 };
 
+static void hdlc_record(int fd, gboolean in, guint8 *data, guint16 length)
+{
+	guint16 len = htons(length);
+	guint32 ts;
+	struct timeval now;
+	unsigned char id;
+	int err;
+
+	if (fd < 0)
+		return;
+
+	gettimeofday(&now, NULL);
+	ts = htonl(now.tv_sec & 0xffffffff);
+
+	id = 0x07;
+	err = write(fd, &id, 1);
+	err = write(fd, &ts, 4);
+
+	id = in ? 0x02 : 0x01;
+	err = write(fd, &id, 1);
+	err = write(fd, &len, 2);
+	err = write(fd, data, length);
+}
+
+void g_at_hdlc_set_recording(GAtHDLC *hdlc, const char *filename)
+{
+	if (hdlc == NULL)
+		return;
+
+	if (hdlc->record_fd > fileno(stderr)) {
+		close(hdlc->record_fd);
+		hdlc->record_fd = -1;
+	}
+
+	if (filename == NULL)
+		return;
+
+	hdlc->record_fd = open(filename, O_WRONLY | O_CREAT | O_APPEND,
+					S_IRUSR | S_IWUSR | S_IRGRP | S_IROTH);
+}
+
 void g_at_hdlc_set_recv_accm(GAtHDLC *hdlc, guint32 accm)
 {
 	if (hdlc == NULL)
@@ -145,6 +194,7 @@ static gboolean received_data(GIOChannel *channel, GIOCondition cond,
 		buf = ring_buffer_write_ptr(hdlc->read_buffer, 0);
 
 		err = g_io_channel_read(channel, (char *) buf, toread, &rbytes);
+		hdlc_record(hdlc->record_fd, TRUE, buf, rbytes);
 		g_at_util_debug_dump(TRUE, buf, rbytes,
 					hdlc->debugf, hdlc->debug_data);
 
@@ -227,6 +277,8 @@ GAtHDLC *g_at_hdlc_new(GIOChannel *channel)
 				G_IO_IN | G_IO_HUP | G_IO_ERR | G_IO_NVAL,
 				received_data, hdlc, read_watch_destroy);
 
+	hdlc->record_fd = -1;
+
 	return hdlc;
 
 error:
@@ -265,6 +317,11 @@ void g_at_hdlc_unref(GAtHDLC *hdlc)
 	if (hdlc->read_watch > 0)
 		g_source_remove(hdlc->read_watch);
 
+	if (hdlc->record_fd > fileno(stderr)) {
+		close(hdlc->record_fd);
+		hdlc->record_fd = -1;
+	}
+
 	g_io_channel_unref(hdlc->channel);
 
 	ring_buffer_free(hdlc->read_buffer);
@@ -314,6 +371,7 @@ static gboolean can_write_data(GIOChannel *channel, GIOCondition cond,
 		return FALSE;
 	}
 
+	hdlc_record(hdlc->record_fd, FALSE, buf, bytes_written);
 	g_at_util_debug_dump(FALSE, buf, bytes_written,
 					hdlc->debugf, hdlc->debug_data);
 
diff --git a/gatchat/gathdlc.h b/gatchat/gathdlc.h
index 143ef2f..2fa3270 100644
--- a/gatchat/gathdlc.h
+++ b/gatchat/gathdlc.h
@@ -49,6 +49,8 @@ void g_at_hdlc_set_receive(GAtHDLC *hdlc, GAtReceiveFunc func,
 							gpointer user_data);
 gboolean g_at_hdlc_send(GAtHDLC *hdlc, const unsigned char *data, gsize size);
 
+void g_at_hdlc_set_recording(GAtHDLC *hdlc, const char *filename);
+
 #ifdef __cplusplus
 }
 #endif