#include "yasnd.h"

GSM_Error error; // structure to store possible gammu errors
GSM_StateMachine *state_machine=NULL; // structure to interact with mobile phones
volatile gboolean gammu_shutdown=FALSE; // variable that indicates gammu shutdown
volatile GSM_Error sms_send_status;

bool check_gammu_error(GSM_Error err)
{
	if (err == ERR_NONE) {
		// No error, return OK('true')
		return true;
	}
	char tmp[150];
	sprintf(tmp,"gammu failure: %s\n", GSM_ErrorString(err));
	log_event(tmp);
	return false;
}

bool gammu_init()
{
	GSM_InitLocales(NULL);
	state_machine = GSM_AllocStateMachine();
	/* Set gammu configuration */
	GSM_Config *gammu_cfg = GSM_GetConfig(state_machine, 0);
	// first, free old values and set new one
	free(gammu_cfg->Device);
	gammu_cfg->Device = strdup("/dev/ttyACM0");
	free(gammu_cfg->Connection);
	gammu_cfg->Connection = strdup("at");
	strcpy(gammu_cfg->Model, "at");
	/* We care only about first configuration */
	GSM_SetConfigNum(state_machine, 1);
	return true;
}

/* Handler for SMS send reply */
void send_sms_callback (GSM_StateMachine *sm, int status, int MessageReference, void * user_data)
{
	char tmp[100];
	if (status==0) {
		sprintf(tmp,"Sent SMS on device '%s' - OK\n", GSM_GetConfig(sm, -1)->Device);
		sms_send_status = ERR_NONE;
		log_debug(tmp,DEBUG_BASE);
	} else {
		sprintf(tmp,"Sent SMS on device '%s' - FAILURE\n", GSM_GetConfig(sm, -1)->Device);
		sms_send_status = ERR_UNKNOWN;
		log_event(tmp);
	}
}

bool gammu_send_sms(const char* message)
{
	GSM_SMSMessage sms;
	GSM_SMSC PhoneSMSC;
	int return_value = 0;

	/* Prepare message */
	// Cleanup the structure
	memset(&sms, 0, sizeof(sms));
	// Encode message text
	EncodeUnicode(sms.Text, message, strlen(message));
	// Encode recipient numbe
	EncodeUnicode(sms.Number, recipient_number, strlen(recipient_number));
	/* We want to submit message */
	sms.PDU = SMS_Submit;
	/* No UDH, just a plain message */
	sms.UDH.Type = UDH_NoUDH;
	/* We used default coding for text */
	sms.Coding = SMS_Coding_Default_No_Compression;
	/* Class 1 message (normal) */
	sms.Class = 1;

	/* Connect to phone */
	/* 1 means number of replies you want to wait for */
	error = GSM_InitConnection(state_machine, 1);
	if (!check_gammu_error(error))
		return false;

	/* Set callback for message sending */
	/* This needs to be done after initiating connection */
	GSM_SetSendSMSStatusCallback(state_machine, send_sms_callback, NULL);

	/* We need to know SMSC number */
	PhoneSMSC.Location = 1;
	error = GSM_GetSMSC(state_machine, &PhoneSMSC);
	if (!check_gammu_error(error))
		return false;

	/* Set SMSC number in message */
	CopyUnicodeString(sms.SMSC.Number, PhoneSMSC.Number);

	log_debug("Prepare to send SMS...",DEBUG_ALL);
	/* Send message */
	error = GSM_SendSMS(state_machine, &sms);
	if (!check_gammu_error(error))
		return false;

	while (!gammu_shutdown) {
		GSM_ReadDevice(state_machine, TRUE);
		if (sms_send_status == ERR_NONE) {
			/* Message sent OK */
			return true;
		}
		if (sms_send_status != ERR_TIMEOUT) {
			/* Message sending failed */
			return false;
		}
	}
	return true;
}