/*******************************************************************************
 * Enhanced TestMode (ETM)
 * @file    etm_api.c
 *
 * API for ETM SWE.
 *
 * @author  Kim T. Peteren (ktp@ti.com)
 * @version 0.1
 *

 *
 * History:
 *
 *  Date        Modification
 *  ------------------------------------
 *  11/06/2003  Creation
 *
 * (C) Copyright 2003 by Texas Instruments Incorporated, All Rights Reserved
 ******************************************************************************/


#include "etm/etm.h"
#include "etm/etm_env.h"
#include "etm/etm_messages_i.h"
#include "etm/etm_trace.h"

#include "etm/etm_misc.h"

#include "rvf/rvf_api.h"

#include <string.h> 

extern T_ETM_ENV_CTRL_BLK *etm_env_ctrl_blk;


/*******************************************************************************
 * Registers the SWE to the ETM instance.
 *
 * This is a bridge function. It sends the T_ETM_REGISTRATION_REQ
 * message to the ETM SWE.
 * It is the first function that should be called.
 *
 * @return  ETM_NOMEM in case of a memory error,
 *          the return value of rvf_send_msg otherwise.
 ******************************************************************************/

int etm_register(char name[], int mid, int task_id, T_RVF_ADDR_ID addr_id, ETM_CALLBACK_FUNC callback)
{
    /* Type for a registration event. */
    T_ETM_REGISTER_REQ *etm_registration_p;

    tr_etm(TgTrEtmLow, "ETM API: _register bridge function(%s)", name);

    /* Allocate the memory for the message to send */
    if ((etm_registration_p = (T_ETM_REGISTER_REQ*) etm_malloc(sizeof(T_ETM_REGISTER_REQ))) == NULL)
            return ETM_NOMEM; 

    /* Fill the message id */
    etm_registration_p->header.msg_id        = ETM_REGISTER_REQ;
 
    /* Fill the address source id */
    etm_registration_p->header.src_addr_id   = rvf_get_taskid(); 
    etm_registration_p->header.dest_addr_id  = etm_env_ctrl_blk->addr_id;
    etm_registration_p->header.callback_func = NULL;

    /* Fill the message parameters */
    memcpy(etm_registration_p->name, name, strlen(name));
    etm_registration_p->mid              = mid;
    etm_registration_p->task_id          = task_id;
    etm_registration_p->addr_id          = addr_id;
    etm_registration_p->rx_callback_func = callback; 

    /* Send the message using mailbox. */
    return rvf_send_msg(etm_env_ctrl_blk->addr_id,
                        (void*) etm_registration_p);
}


/*******************************************************************************
 * Cleans ETM register tables, i.e. set/clean the variable at their initialization
 * state for a specific entity.
 * This function can be used to reinitialize ETM register database without having to
 * start/stop it.
 *
 * This is a bridge function. It sends ETM_UNREGISTER message to ETM.
 *
 * @return  ETM_NOMEM in case of a memory error,
 *          the return value of rvf_send_msg otherwise.
 ******************************************************************************/

int etm_unregister(char name[], int mid, int task_id, T_RVF_ADDR_ID addr_id, ETM_CALLBACK_FUNC callback)
{
    /* Type for a start input event. */
    T_ETM_UNREGISTER *etm_unregister_p;
    
    tr_etm(TgTrEtmLow, "ETM API: _unregister bridge function");
    
    /* Allocate the memory for the message to send */
    if ((etm_unregister_p = (T_ETM_UNREGISTER*) etm_malloc(sizeof(T_ETM_UNREGISTER))) == NULL)
            return ETM_NOMEM; 

    /* Fill the message id */
    etm_unregister_p->header.msg_id        = ETM_UNREGISTER;
 
    /* Fill the address source id */
    etm_unregister_p->header.src_addr_id   = rvf_get_taskid(); 
    etm_unregister_p->header.dest_addr_id  = etm_env_ctrl_blk->addr_id;
    etm_unregister_p->header.callback_func = NULL;

    /* Fill the message parameters */
    memcpy(etm_unregister_p->name, name, strlen(name));
    etm_unregister_p->mid              = mid;
    etm_unregister_p->task_id          = task_id;
    etm_unregister_p->addr_id          = addr_id;
    etm_unregister_p->rx_callback_func = callback;

    /* Send the message using mailbox. */
    return rvf_send_msg(etm_env_ctrl_blk->addr_id,
                        (void*) etm_unregister_p);
}


/*******************************************************************************
 * Get data from a ETM packet structur. Get either 8, 16 or 32 value
 * Used to unpack data 
 * 
 * This is helpers
 *
 * @return  the return value of the point of the ETM packet.
 ******************************************************************************/

int etm_get8(void *buf)
{
    unsigned char *p = buf;

    int value = *p;

    tr_etm(TgTrEtmLow, "ETM API: _get8(%d)", value);

    return value;
}

int etm_get16(void *buf)
{
   unsigned char *p = buf;

    int value =
        (*p++ | (*p << 8));

    tr_etm(TgTrEtmLow, "ETM API: _get16(%d)", value);

    return value;
}

int etm_get32(void *buf)
{
    unsigned char *p = buf;
    int value = 0;
   
    value = *p;
    p++;
    value |= (*p << 8);
    p++;
    value |= (*p << 16);
    p++;
    value |= (*p << 24);

    tr_etm(TgTrEtmLow, "ETM API: _get32(%d)", value);

    return value;
}


/*******************************************************************************
 * Put data into a ETM packet structur. Put either 8, 16 or 32 value
 * Used to pack data 
 * 
 * This is helpers
 *
 * @return  Return ETM_PACKET of ETM_OK.
 ******************************************************************************/

#define max_ul_data_size 240

int etm_pkt_put8(T_ETM_PKT *pkt, int value)
{
    tr_etm(TgTrEtmLow, "ETM API: _pkt_put8(*, %d)", value);

    if (pkt->index + 1 > max_ul_data_size) 
        return ETM_PACKET;
    
    pkt->data[pkt->index] = value;
    pkt->index += 1;

    pkt->size += 1;

    return ETM_OK;
}

int etm_pkt_put16(T_ETM_PKT *pkt, int value)
{
    tr_etm(TgTrEtmLow, "ETM API: _pkt_put16(*, %d)", value);

    if (pkt->index + 2 > max_ul_data_size) 
        return ETM_PACKET;

    memcpy(&pkt->data[pkt->index], &value, 2);
    pkt->index += 2;

    pkt->size += 2;

    return ETM_OK;
}

int etm_pkt_put32(T_ETM_PKT *pkt, int value)
{
    tr_etm(TgTrEtmLow, "ETM API: _pkt_put32(*, %d)", value);

    if (pkt->index + 4 > max_ul_data_size) 
        return ETM_PACKET;

    memcpy(&pkt->data[pkt->index], &value, 4);
    pkt->index += 4;

    pkt->size += 4;

    return ETM_OK;
}

int  etm_pkt_putdata(T_ETM_PKT *pkt, const void *buf, int size)
{
    tr_etm(TgTrEtmLow, "ETM API: _pkt_putdata(*, %d)", size);

    if (pkt->index + size > max_ul_data_size)
        return ETM_PACKET;
    memcpy(&pkt->data[pkt->index], buf, size);
    pkt->index += size;

    pkt->size += size;
  
    return ETM_OK;
}


/*******************************************************************************
 * This function is used to send an ETM Packet to the PC
 *
 * This is helpers
 *
 * @return  Return value of rvf_send_trace_cpy.
 ******************************************************************************/

int etm_pkt_send(T_ETM_PKT *pkt)
{
    extern unsigned char etm_trace_user_id; 
    uint8 *buf, cksum = 0;
    uint16 sendsize, size;
    int error = ETM_OK;

    buf = (uint8 *) &pkt->mid;
    sendsize = size = pkt->size + 2; //one for mid, one for status

    tr_etm(TgTrEtmLow, "ETM API: _pkt_send: size(%d)", sendsize);

    while (size-- ) {
        cksum ^= *buf++;
    }
    *buf = cksum;

    sendsize += 1; // one for checksum

    tr_etm_hexdump(TgTrEtmLow, &pkt->mid, sendsize);

    error = rvt_send_trace_cpy((uint8 *) &pkt->mid, etm_trace_user_id,
                               sendsize, RVT_BINARY_FORMAT);
    if(error < 0)
        tr_etm(TgTrFatal, "ETM API: _pkt_send: ERROR(%d)", error);

    return error;
}