view src/cs/riviera/rvt/rvt_keepalive.c @ 50:a9a7d531e673

components: initial support for gcc
author Mychaela Falconia <falcon@freecalypso.org>
date Thu, 19 Jul 2018 19:23:19 +0000
parents b6a5e36de839
children
line wrap: on
line source

/*
 * This module is a FreeCalypso addition.  Here we implement the special
 * operation mode that is only used when a device that was originally
 * meant to be a phone handset is turned into a pseudo-modem with no UI,
 * requiring connection to a host computer running rvinterf for control.
 */

#ifdef PSEUDO_MODEM_KEEPALIVE

#include "nucleus.h"

#include "abb.h"

#include "rv/general.h"
#include "rv/rv_general.h"
#include "rvf/rvf_api.h"
#include "rvt/rvt_gen.h"
#include "rvt/rvt_def_i.h"
#include "rvt/rvt_env.h"
#include "rvt/rvt_env_i.h"
#include "rvm/rvm_use_id_list.h"

#include "uart/serialswitch.h"

#include <string.h>

volatile UINT8 rvt_keepalive_counter;

void rvt_keepalive_input(T_RVT_BUFFER p_msg, UINT16 msg_length)
{
	/* Checking for an invalid PDU. */
	if ((p_msg == NULL) || (msg_length != 1))
		return;

	/* Check for the correct opcode */
	if (*p_msg != 'A')
		return;

	/* good keepalive response from external host */
	rvt_keepalive_counter = 0;
}

void rvt_keepalive_register(void)
{
	T_RVT_USER_ID rvt_id;

	rvt_register_id("KEEPALIVE", &rvt_id, rvt_keepalive_input);
}

static void keepalive_send(UINT8 *buf, UINT32 size)
{
	UINT32 sent;

	for (sent = 0; sent < size; )
		sent += SER_tr_WriteNBytes(SER_LAYER_1, buf + sent,
					   size - sent);
}

#ifdef PSEUDO_MODEM_USB
static char poweroff_msg[] = "System: USB unplugged, powering off";
#else
static char poweroff_msg[] = "System: no keepalive response, powering off";
static UINT8 keepalive_msg[2] = {RVT_KEEPALIVE_HEADER, 'Q'};
#endif

static void keepalive_poweroff(void)
{
	UINT8 poweroff_msg_buf[50], *p;

	p = poweroff_msg_buf;
	*p++ = RVT_RV_HEADER;
	*p++ = 0;
	*p++ = 0;
	*p++ = 0;
	*p++ = 0;
	*p++ = RV_TRACE_LEVEL_ERROR;
	strcpy((char *)p, poweroff_msg);
	keepalive_send(poweroff_msg_buf, strlen(poweroff_msg) + 6);
	/* do it */
	ABB_Power_Off();
}

void rvt_keepalive_process(void)
{
	SYS_UWORD16 abb_status;

	abb_status = ABB_Read_Status();
	if (abb_status & CHGPRES) {
		rvt_keepalive_counter = 0;
		return;
	}

#ifdef PSEUDO_MODEM_USB
	keepalive_poweroff();
#else
	if (rvt_keepalive_counter >= 3)
		keepalive_poweroff();
	else {
		rvt_keepalive_counter++;
		keepalive_send(keepalive_msg, sizeof keepalive_msg);
	}
#endif
}

#endif