FreeCalypso > hg > fc-tourmaline
view src/cs/riviera/rvt/rvt_keepalive.c @ 164:0b8ebd4dd2ef
mmiSatInfo.c: bogotab fixes
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Wed, 18 Nov 2020 23:24:36 +0000 |
parents | 4e78acac3d88 |
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