freecalypso-sw: nuc-fw/riviera/rvt/rvt

annotate nuc-fw/riviera/rvt/rvt_task.c @ 132:2c5160a9d652

nuc-fw: switched from nucdemo to Riviera, got some serial output

author	Michael Spacefalcon <msokolov@ivan.Harhan.ORG>
date	Sat, 02 Nov 2013 01:48:11 +0000
parents	28f967578233
children	3b5c3f3646fb

rev	line source
118 21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	1 /**************************************************************************
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	2 *
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	3 * rvt_task.c
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	4 *
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	5 * This contains the core of the Trace task.
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	6 *
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	7 * (C) Texas Instruments, all rights reserved
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	8 *
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	9 * Version number : 0.1
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	10 *
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	11 * History : 0.1 (7/5/2000) - Created
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	12 *
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	13 * Date : 7/5/2000
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	14 *
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	15 * Author : Guido Pagana
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	16 *
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	17 * Update : Pascal Puel
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	18 * : David Lamy-Charrier (changes for Riviera 1.6)
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	19 *
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	20 ***************************************************************************/
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	21
122 28f967578233 RVT compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 118 diff changeset	22 #include "../../include/config.h"
118 21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	23
122 28f967578233 RVT compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 118 diff changeset	24 #include "../rv/general.h"
28f967578233 RVT compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 118 diff changeset	25 #include "../rv/rv_general.h"
28f967578233 RVT compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 118 diff changeset	26 #include "../rvf/rvf_api.h"
28f967578233 RVT compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 118 diff changeset	27 #include "rvt_gen.h"
28f967578233 RVT compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 118 diff changeset	28 #include "rvt_def_i.h"
28f967578233 RVT compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 118 diff changeset	29 #include "rvt_env.h"
28f967578233 RVT compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 118 diff changeset	30 #include "rvt_env_i.h"
28f967578233 RVT compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 118 diff changeset	31 #include "../rvm/rvm_use_id_list.h"
118 21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	32
122 28f967578233 RVT compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 118 diff changeset	33 #include "../../serial/serialswitch.h"
118 21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	34
122 28f967578233 RVT compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 118 diff changeset	35 #include "../../nucleus/nucleus.h"
118 21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	36
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	37 #include <string.h>
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	38
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	39 extern NU_HISR TI_rcv_HISR;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	40
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	41 /* Time (in milliseconds) between two consecutive 'System Time' messages */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	42 #define RVT_ALIVE_POLLING_TIME (RVF_MS_TO_TICKS (20000))
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	43
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	44 #define RVT_WAIT_FOR_HEADER (1)
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	45 #define RVT_WAIT_FOR_DATA (2)
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	46
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	47
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	48 /********************************************************************************/
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	49 /* */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	50 /* Function Name: rvt_task_core */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	51 /* */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	52 /* Purpose: Core of Trace task. */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	53 /* */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	54 /* Input Parameters: */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	55 /* None. */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	56 /* */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	57 /* Output Parameters: */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	58 /* None. */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	59 /* */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	60 /* Global Parameters: */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	61 /* None. */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	62 /* */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	63 /* Note: */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	64 /* None. */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	65 /* */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	66 /********************************************************************************/
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	67 T_RVM_RETURN rvt_task_core (void)
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	68 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	69 UINT16 event = 0;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	70 UINT32 nb_bytes_sent = 0;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	71
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	72 #ifdef FRAMING_PROTOCOL
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	73
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	74 // Request for the level of filtering, as well as the 32-bit
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	75 // mask related to the software entities to be monitored.
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	76 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	77 UINT8 trace_level_request[] = {RVM_INVALID_USE_ID, 0, 0, 0, 0, (RV_TRACE_LEVEL_ERROR - 1), 0, 0, 0, 0};
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	78
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	79 // Note that the level is defined as invalid
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	80 trace_level_request[0] = (char) rv_trace_user_id;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	81
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	82 // Transmit an 'empty' message
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	83 nb_bytes_sent = 0;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	84 while (nb_bytes_sent < sizeof (trace_level_request))
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	85 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	86 nb_bytes_sent += SER_tr_WriteNBytes (SER_LAYER_1,
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	87 trace_level_request + nb_bytes_sent,
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	88 sizeof (trace_level_request) - nb_bytes_sent);
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	89 }
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	90 }
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	91
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	92 // Start the 'Alive Polling Timer'
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	93 #if (OP_WCP == 0)
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	94 rvf_start_timer (RVF_TIMER_0,
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	95 RVT_ALIVE_POLLING_TIME,
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	96 TRUE);
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	97 #endif
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	98
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	99 for (;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	100 ;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	101 )
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	102 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	103 // Infinite wait on 'Trace Task' mailbox or timer events
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	104 event = rvf_wait ((1 << RVT_TRACE_MAILBOX) \| (RVF_TIMER_0_EVT_MASK),
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	105 0);
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	106
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	107 // Check for some messages lost
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	108 if (((rvt_lost_msg_cpt.bit_mask).count >= RVT_MAX_LOST_TRACE_MSG) && (p_rvt_lost_msg))
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	109 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	110 INT8 count = 0;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	111 UINT8 lost_msg_length = RVT_HDR_LENGTH + RVT_LOST_MSG_LENGTH;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	112 UINT32 lost_msg_cpt = rvt_lost_msg_cpt.overall_value;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	113
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	114 // Append with the number of messages lost
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	115 rvt_lost_msg_cpt.overall_value = 0;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	116 for (count = 0;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	117 count < RVT_HEX_VALUE_LENGTH;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	118 count++)
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	119 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	120 p_rvt_lost_msg[lost_msg_length + count] = Num2Char[(UINT8) ((lost_msg_cpt << (count << 2)) >> 28)];
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	121 }
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	122 lost_msg_length += RVT_HEX_VALUE_LENGTH;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	123
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	124 // Send message to the UART with byte stuffing
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	125 nb_bytes_sent = 0;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	126 while (nb_bytes_sent < lost_msg_length)
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	127 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	128 nb_bytes_sent += SER_tr_WriteNBytes (SER_LAYER_1,
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	129 (UINT8 *) p_rvt_lost_msg + nb_bytes_sent,
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	130 lost_msg_length - nb_bytes_sent);
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	131 }
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	132
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	133 } // End of if ((rvt_lost_msg_cpt.bit_mask).count >= RVT_MAX_LOST_TRACE_MSG)
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	134
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	135 if (event & EVENT_MASK (RVT_TRACE_MAILBOX))
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	136 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	137 T_RV_HDR *msg = NULL;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	138
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	139 // Read the message from the mailbox
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	140 if ((msg = (T_RV_HDR *) rvf_read_mbox (RVT_TRACE_MAILBOX)) != NULL)
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	141 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	142 if (msg->msg_id == RVT_TRACE_RQST_ID)
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	143 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	144 UINT8 msg_format = 0;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	145 UINT32 msg_length = 0;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	146
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	147 // Get the length
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	148 msg_length = ((T_RVT_TRACE_RQST *) msg)->msg_length;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	149
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	150 // Get the format
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	151 msg_format = ((T_RVT_TRACE_RQST *) msg)->format;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	152
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	153 // Copy the 'User ID'
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	154 ((UINT8 ) msg + RVT_HEADER_SIZE - 1)[0] = ((T_RVT_TRACE_RQST ) msg)->user_id;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	155 msg_length++;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	156
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	157 switch (msg_format)
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	158 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	159 case RVT_ASCII_FORMAT:
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	160 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	161 // Send message to the UART without byte stuffing
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	162 nb_bytes_sent = 0;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	163 while (nb_bytes_sent < msg_length)
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	164 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	165 nb_bytes_sent += SER_tr_EncapsulateNChars (SER_LAYER_1,
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	166 (char *) msg + RVT_HEADER_SIZE - 1 + nb_bytes_sent,
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	167 msg_length - nb_bytes_sent);
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	168 }
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	169 break;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	170 }
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	171 case RVT_BINARY_FORMAT:
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	172 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	173 // Send message to the UART with byte stuffing
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	174 nb_bytes_sent = 0;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	175 while (nb_bytes_sent < msg_length)
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	176 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	177 nb_bytes_sent += SER_tr_WriteNBytes (SER_LAYER_1,
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	178 (UINT8 *) msg + RVT_HEADER_SIZE - 1 + nb_bytes_sent,
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	179 msg_length - nb_bytes_sent);
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	180 }
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	181 break;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	182 }
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	183 default:
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	184 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	185 // Increment the number of messages lost.
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	186 // Is the buffer corrupted?
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	187 (rvt_lost_msg_cpt.bit_mask).count++;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	188 (rvt_lost_msg_cpt.bit_mask).unknown_format = 1;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	189 break;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	190 }
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	191 }
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	192
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	193 // Deallocate the buffer
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	194 rvf_free_buf (msg);
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	195
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	196 } // End of if (msg->msg_id == RVT_TRACE_RQST_ID)
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	197
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	198 else
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	199 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	200 // Increment the number of messages lost. Is the buffer
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	201 // corrupted?
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	202 (rvt_lost_msg_cpt.bit_mask).count++;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	203 (rvt_lost_msg_cpt.bit_mask).unknown_request = 1;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	204 }
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	205
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	206 } // End of if (msg != NULL)
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	207
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	208 else
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	209 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	210 // Increment the number of messages lost. Is the buffer
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	211 // corrupted?
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	212 (rvt_lost_msg_cpt.bit_mask).count++;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	213 (rvt_lost_msg_cpt.bit_mask).message_empty = 1;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	214 }
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	215
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	216 } // End of if (event & EVENT_MASK (RVT_TRACE_MAILBOX))
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	217
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	218 if ((event & (RVF_TIMER_0_EVT_MASK)) && (p_rvt_sys_time))
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	219 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	220 UINT8 count = 0;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	221 UINT8 sys_time_length = RVT_HDR_LENGTH + RVT_SYS_TIME_LENGTH;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	222 UINT32 current_time = rvf_get_tick_count ();
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	223
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	224 // Append with the system time
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	225 for (count = 0;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	226 count < RVT_HEX_VALUE_LENGTH;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	227 count++)
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	228 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	229 p_rvt_sys_time[sys_time_length + count] = Num2Char[(UINT8) ((current_time << (count << 2)) >> 28)];
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	230 }
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	231 sys_time_length += RVT_HEX_VALUE_LENGTH;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	232
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	233 // Send message to the UART with byte stuffing
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	234 nb_bytes_sent = 0;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	235 while (nb_bytes_sent < sys_time_length)
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	236 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	237 nb_bytes_sent += SER_tr_WriteNBytes (SER_LAYER_1,
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	238 (UINT8 *) p_rvt_sys_time + nb_bytes_sent,
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	239 sys_time_length - nb_bytes_sent);
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	240 }
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	241
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	242 } // End of if (event & (RVF_TIMER_0_EVT_MASK))
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	243 }
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	244 #else
122 28f967578233 RVT compiles Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: 118 diff changeset	245
118 21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	246 // Start the 'Alive Polling Timer'
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	247 #if (OP_WCP == 0)
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	248 rvf_start_timer (RVF_TIMER_0,
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	249 RVT_ALIVE_POLLING_TIME,
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	250 TRUE);
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	251 #endif
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	252
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	253 for (;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	254 ;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	255 )
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	256 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	257 // Infinite wait on 'Trace Task' mailbox or timer events
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	258 event = rvf_wait ((1 << RVT_TRACE_MAILBOX) \| (RVF_TIMER_0_EVT_MASK),
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	259 0);
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	260
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	261 // Check for some messages lost
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	262 if (((rvt_lost_msg_cpt.bit_mask).count >= RVT_MAX_LOST_TRACE_MSG) && (p_rvt_lost_msg))
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	263 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	264 INT8 count = 0;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	265 UINT8 lost_msg_length = RVT_LOST_MSG_LENGTH;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	266 UINT32 lost_msg_cpt = rvt_lost_msg_cpt.overall_value;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	267
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	268 // Append with the number of messages lost
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	269 rvt_lost_msg_cpt.overall_value = 0;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	270 for (count = 0;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	271 count < RVT_HEX_VALUE_LENGTH;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	272 count ++)
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	273 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	274 p_rvt_lost_msg[lost_msg_length + count] = Num2Char[(UINT8) ((lost_msg_cpt << (count << 2)) >> 28)];
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	275 }
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	276 rvt_lost_msg_length += RVT_HEX_VALUE_LENGTH;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	277
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	278 // Append with the '\n' and '\r' characters for the hyper terminal
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	279 p_rvt_lost_msg[lost_msg_length++] = '\n';
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	280 p_rvt_lost_msg[lost_msg_length++] = '\r';
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	281
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	282 // Send the message to the UART without byte stuffing
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	283 nb_bytes_sent = 0;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	284 while (nb_bytes_sent < lost_msg_length)
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	285 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	286 nb_bytes_sent += SER_tr_WriteNChars (SER_LAYER_1,
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	287 (UINT8 *) p_rvt_lost_msg + nb_bytes_sent,
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	288 lost_msg_length - nb_bytes_sent);
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	289 }
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	290
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	291 } // End of if ((rvt_lost_msg_cpt.bit_mask).count >= RVT_MAX_LOST_TRACE_MSG)
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	292
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	293 if (event & EVENT_MASK (RVT_TRACE_MAILBOX))
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	294 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	295 T_RV_HDR *msg = NULL;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	296
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	297 // Read the message from the mailbox
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	298 if ((msg = (T_RV_HDR *) rvf_read_mbox (RVT_TRACE_MAILBOX)) != NULL)
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	299 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	300 if (msg->msg_id == RVT_TRACE_RQST_ID)
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	301 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	302 UINT32 msg_length = 0;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	303
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	304 // Get the length
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	305 msg_length = ((T_RVT_TRACE_RQST *) msg)->msg_length;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	306
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	307 // Send message to the UART without byte stuffing
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	308 nb_bytes_sent = 0;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	309 while (nb_bytes_sent < msg_length)
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	310 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	311 nb_bytes_sent += SER_tr_WriteNChars (SER_LAYER_1,
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	312 msg + RVT_HEADER_SIZE + nb_bytes_sent,
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	313 msg_length - nb_bytes_sent);
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	314 }
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	315
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	316 // Append with the '\n' and '\r' characters for the hyper terminal
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	317 msg_length = 0;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	318 msg[msg_length++] = '\n';
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	319 msg[msg_length++] = '\r';
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	320
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	321 // Send message to the UART without byte stuffing
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	322 nb_bytes_sent = 0;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	323 while (nb_bytes_sent < msg_length)
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	324 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	325 nb_bytes_sent += SER_tr_WriteNChars (SER_LAYER_1,
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	326 msg + nb_bytes_sent,
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	327 msg_length - nb_bytes_sent);
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	328 }
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	329
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	330 // Deallocate the buffer
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	331 rvf_free_buf (msg);
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	332
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	333 } // End of if (msg->msg_id == RVT_TRACE_RQST_ID)
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	334
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	335 else
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	336 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	337 // Increment the number of messages lost. Is the buffer
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	338 // corrupted?
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	339 (rvt_lost_msg_cpt.bit_mask).count++;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	340 (rvt_lost_msg_cpt.bit_mask).unknown_request = 1;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	341 }
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	342
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	343 } // End of if (msg != NULL)
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	344
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	345 else
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	346 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	347 // Increment the number of messages lost. Is the buffer
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	348 // corrupted?
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	349 (rvt_lost_msg_cpt.bit_mask).count++;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	350 (rvt_lost_msg_cpt.bit_mask).message_empty = 1;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	351 }
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	352
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	353 } // End of if (event & EVENT_MASK (RVT_TRACE_MAILBOX))
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	354
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	355 if ((event & (RVF_TIMER_0_EVT_MASK)) && (p_rvt_sys_time))
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	356 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	357 UINT8 count = 0;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	358 UINT8 sys_time_length = RVT_SYS_TIME_LENGTH;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	359 UINT32 current_time = rvf_get_tick_count ();
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	360
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	361 // Append with the system time
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	362 for (count = 0;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	363 count < RVT_HEX_VALUE_LENGTH;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	364 count++)
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	365 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	366 p_rvt_sys_time[sys_time_length + count] = Num2Char[(UINT8) ((current_time << (count << 2)) >> 28)];
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	367 }
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	368 sys_time_length += RVT_HEX_VALUE_LENGTH;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	369
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	370 // Append with the '\n' and '\r' characters for the hyper terminal
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	371 p_rvt_sys_time[sys_time_length++] = '\n';
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	372 p_rvt_sys_time[sys_time_length++] = '\r';
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	373
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	374 // Send message to the UART without byte stuffing
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	375 nb_bytes_sent = 0;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	376 while (nb_bytes_sent < sys_time_length)
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	377 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	378 nb_bytes_sent += SER_tr_WriteNChars (SER_LAYER_1,
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	379 (UINT8 *) p_rvt_sys_time + nb_bytes_sent,
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	380 sys_time_length - nb_bytes_sent);
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	381 }
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	382
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	383 } // End of if (event & (RVF_TIMER_0_EVT_MASK))
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	384 }
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	385 #endif
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	386 }
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	387
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	388
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	389 /********************************************************************************/
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	390 /* */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	391 /* Function Name: rvt_RX_process */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	392 /* */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	393 /* Purpose: This function is called when characters are received */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	394 /* on the serial port on receive HISR. */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	395 /* */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	396 /* Input Parameters: */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	397 /* None. */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	398 /* */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	399 /* Output Parameters: */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	400 /* None. */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	401 /* */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	402 /* Global Parameters: */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	403 /* None. */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	404 /* */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	405 /* Note: */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	406 /* None. */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	407 /* */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	408 /********************************************************************************/
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	409 void rvt_RX_process (void)
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	410 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	411 UINT32 bytesRead;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	412 static UINT8 inBuffer[255];
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	413
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	414 #ifdef FRAMING_PROTOCOL
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	415 BOOL eof = 0;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	416 static UINT8 rcv_state = RVT_WAIT_FOR_HEADER;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	417 static UINT32 total_bytesRead = 0;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	418 static RVT_CALLBACK_FUNC rx_callback_func = NULL;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	419
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	420 // Get all bytes from the UART RX FIFO
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	421 for (;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	422 ;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	423 )
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	424 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	425 // Read and destuff the UART RX FIFO and fill inBuffer with received
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	426 // bytes
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	427 bytesRead = SER_tr_ReadNBytes (SER_LAYER_1,
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	428 (char *) (inBuffer + total_bytesRead),
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	429 sizeof (inBuffer) - total_bytesRead,
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	430 &eof);
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	431
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	432 // Check for the header. Hence, get the sendee
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	433 if ((rcv_state == RVT_WAIT_FOR_HEADER) && \
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	434 (bytesRead) && \
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	435 !(total_bytesRead))
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	436 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	437 if ((inBuffer[0] == RVT_RV_HEADER) \|\| \
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	438 (inBuffer[0] == RVT_L1_HEADER) \|\| \
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	439 (inBuffer[0] == RVT_L23_HEADER) \|\| \
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	440 (inBuffer[0] == RVT_TM_HEADER) \|\| \
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	441 (inBuffer[0] == RVT_RNET_HEADER) \|\| \
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	442 (inBuffer[0] == RVT_PROF_HEADER) \|\| \
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	443 (inBuffer[0] == RVT_GTTBACK_HEADER) \|\| \
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	444 (inBuffer[0] == RVT_OTHER_HEADER))
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	445 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	446 UINT8 idtab = 0;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	447
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	448 // Search for the ID in the table
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	449 for (idtab = 0;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	450 rvt_user_db[idtab].user_id != RVT_INVALID_HEADER;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	451 idtab++)
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	452 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	453 if (rvt_user_db[idtab].user_id == inBuffer[0])
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	454 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	455 rx_callback_func = rvt_user_db[idtab].rx_callback_func;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	456 break;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	457 }
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	458 }
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	459 rcv_state = RVT_WAIT_FOR_DATA;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	460 }
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	461 }
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	462
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	463 // Update the total number of bytes read, regarding the current frame
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	464 total_bytesRead += bytesRead;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	465
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	466 // Call the corresponding callback function when a complete message is
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	467 // received (eof odd)
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	468 if (eof & 0x01)
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	469 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	470 // Invoke the callback function
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	471 if (rx_callback_func != NULL)
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	472 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	473 rx_callback_func ((T_RVT_BUFFER) (inBuffer + 1),
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	474 total_bytesRead - 1);
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	475 rx_callback_func = NULL;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	476 }
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	477
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	478 // Wait for the next frame to come
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	479 rcv_state = RVT_WAIT_FOR_HEADER;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	480 total_bytesRead = 0;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	481 }
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	482
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	483 // inBuffer may be full due to some synchro lost problems
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	484 else if (total_bytesRead == sizeof (inBuffer))
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	485 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	486 // If still waiting for the header, discard received characters and
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	487 // reset static variables for the next frame to come
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	488 if (rcv_state == RVT_WAIT_FOR_HEADER)
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	489 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	490 total_bytesRead = 0;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	491 break;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	492 }
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	493
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	494 // Just discard characters received as payload
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	495 total_bytesRead = sizeof (inBuffer[0]);
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	496 }
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	497
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	498 // Proceed with the next concatenated frame whether more bytes left
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	499 if (eof > 1)
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	500 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	501 continue;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	502 }
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	503 break;
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	504 }
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	505 #else
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	506
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	507 // Read the UART RX FIFO and fill inBuffer with received bytes
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	508 bytesRead = SER_tr_ReadNChars (SER_LAYER_1,
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	509 (char *) inBuffer,
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	510 sizeof (inBuffer));
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	511
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	512 // Invoke the Testmode callback function : this is the only one able,
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	513 // for the moment, to send an external command !! WARNING : This
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	514 // should be the same name than the one already registered in
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	515 // create_RVtasks.c.
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	516 tm_receive ((T_RVT_BUFFER) inBuffer,
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	517 bytesRead);
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	518 #endif
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	519 }
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	520
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	521
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	522
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	523 /********************************************************************************/
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	524 /* */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	525 /* Function Name: rvt_activate_RX_HISR */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	526 /* */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	527 /* Purpose: This function is called when an RX interrupt occurs. */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	528 /* */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	529 /* Input Parameters: */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	530 /* None. */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	531 /* */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	532 /* Output Parameters: */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	533 /* None. */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	534 /* */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	535 /* Global Parameters: */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	536 /* None. */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	537 /* */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	538 /* Note: */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	539 /* None. */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	540 /* */
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	541 /********************************************************************************/
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	542 void rvt_activate_RX_HISR (void)
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	543 {
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	544 NU_Activate_HISR (&TI_rcv_HISR);
21de8d8e6ea7 checking in Riviera code from the Sotomodem version Michael Spacefalcon <msokolov@ivan.Harhan.ORG> parents: diff changeset	545 }

FreeCalypso > hg > freecalypso-sw

annotate nuc-fw/riviera/rvt/rvt_task.c @ 132:2c5160a9d652