1 files changed, 115 insertions, 0 deletions
diff --git a/gammu/emb/common/phone/nokia/dct4/dct4func.c b/gammu/emb/common/phone/nokia/dct4/dct4func.c
new file mode 100644
index 0000000..9fa931f
--- a/dev/null
+++ b/gammu/emb/common/phone/nokia/dct4/dct4func.c
@@ -0,0 +1,115 @@
+/* (c) 2002-2003 by Marcin Wiacek */
+
+#include "../../../gsmstate.h"
+
+#include <string.h>
+#include <time.h>
+
+#include "../../../gsmcomon.h"
+#include "../../../misc/coding/coding.h"
+#include "../../../service/gsmlogo.h"
+#include "../nfunc.h"
+#include "../nfuncold.h"
+#include "../../pfunc.h"
+#include "dct4func.h"
+
+#ifdef GSM_ENABLE_NOKIA_DCT4
+
+GSM_Error DCT4_ReplyGetPhoneMode(GSM_Protocol_Message msg, GSM_StateMachine *s)
+{
+	s->Phone.Data.PhoneString[0] = msg.Buffer[4];
+	return ERR_NONE;
+}
+
+GSM_Error DCT4_GetPhoneMode(GSM_StateMachine *s)
+{
+	unsigned char req[] = {N6110_FRAME_HEADER, 0x02, 0x00, 0x00};
+
+	smprintf(s,"Getting phone mode\n");
+
+	return GSM_WaitFor (s, req, 6, 0x15, 4, ID_Reset);
+}
+
+GSM_Error DCT4_ReplySetPhoneMode(GSM_Protocol_Message msg, GSM_StateMachine *s)
+{
+	return ERR_NONE;
+}
+
+GSM_Error DCT4_SetPhoneMode(GSM_StateMachine *s, DCT4_PHONE_MODE mode)
+{
+	unsigned char PhoneMode[10];
+	int	      i;
+	GSM_Error     error;
+	unsigned char req[] = {N6110_FRAME_HEADER, 0x01,
+			       0x04,		/* phone mode */
+			       0x00};
+
+	if (s->ConnectionType != GCT_FBUS2) return ERR_OTHERCONNECTIONREQUIRED;
+
+	s->Phone.Data.PhoneString 	= PhoneMode;
+	req[4] 				= mode;
+
+	while (1) {
+		smprintf(s,"Going to phone mode %i\n",mode);
+		error = GSM_WaitFor (s, req, 6, 0x15, 4, ID_Reset);
+		if (error != ERR_NONE) return error;
+		for (i=0;i<20;i++) {
+			error=DCT4_GetPhoneMode(s);
+			if (error != ERR_NONE) return error;
+			if (PhoneMode[0] == mode) return ERR_NONE;
+			my_sleep(500);
+		}
+	}
+	return ERR_NONE;
+}
+
+GSM_Error DCT4_ReplyGetIMEI(GSM_Protocol_Message msg, GSM_StateMachine *s)
+{
+	memcpy(s->Phone.Data.IMEI,msg.Buffer + 10, 16);
+	smprintf(s, "Received IMEI %s\n",s->Phone.Data.IMEI);
+	return ERR_NONE;
+}
+
+GSM_Error DCT4_GetIMEI (GSM_StateMachine *s)
+{
+	unsigned char req[5] = {N6110_FRAME_HEADER, 0x00, 0x41};
+
+	smprintf(s, "Getting IMEI\n");
+	return GSM_WaitFor (s, req, 5, 0x1B, 2, ID_GetIMEI);
+}
+
+GSM_Error DCT4_GetHardware(GSM_StateMachine *s, char *value)
+{
+	return NOKIA_GetPhoneString(s,"\x00\x03\x02\x07\x00\x02",6,0x1b,value,ID_GetHardware,10);
+}
+
+GSM_Error DCT4_GetProductCode(GSM_StateMachine *s, char *value)
+{
+	return NOKIA_GetPhoneString(s,"\x00\x03\x04\x0b\x00\x02",6,0x1b,value,ID_GetProductCode,10);
+}
+
+GSM_Error DCT4_Reset(GSM_StateMachine *s, bool hard)
+{
+	unsigned char req[] = {N6110_FRAME_HEADER, 0x05,
+			       0x80,		/* 0x80 - reset, 0x00 - off */
+			       0x00};
+//	unsigned char TimeReq[] = {N6110_FRAME_HEADER, 0x0E, 0x00, 0x00};
+
+	if (hard) return ERR_NOTSUPPORTED;
+
+//	error = DCT4_SetPhoneMode(s, DCT4_MODE_TEST);
+//	if (error != ERR_NONE) return error;
+//	error = DCT4_SetPhoneMode(s, DCT4_MODE_NORMAL);
+//	if (error != ERR_NONE) return error;
+
+	s->Phone.Data.EnableIncomingSMS = false;
+	s->Phone.Data.EnableIncomingCB  = false;
+
+	return GSM_WaitFor (s, req, 6, 0x15, 2, ID_Reset);
+}
+
+#endif
+
+/* How should editor hadle tabs in this file? Add editor commands here.
+ * vim: noexpandtab sw=8 ts=8 sts=8:
+ */