RP-77A/cva_asw_m0128/SDK/middleware/uds/user/uds_service36.c

/*
 * Copyright (c) 2022, Shenzhen CVA Innovation CO.,LTD
 * All rights reserved.
 *
 * Shenzhen CVA Innovation CO.,LTD (CVA chip) is supplying this file for use
 * exclusively with CVA's microcontroller products. This file can be freely
 * distributed within development tools that are supporting such microcontroller
 * products.
 * 
 * THIS SOFTWARE IS PROVIDED "AS IS".  NO WARRANTIES, WHETHER EXPRESS, IMPLIED
 * OR STATUTORY, INCLUDING, BUT NOT LIMITED TO, IMPLIED WARRANTIES OF
 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE APPLY TO THIS SOFTWARE.
 * CVA SHALL NOT, IN ANY CIRCUMSTANCES, BE LIABLE FOR SPECIAL, INCIDENTAL,
 * OR CONSEQUENTIAL DAMAGES, FOR ANY REASON WHATSOEVER.
 */

/*******************************************************************************
 * the includes
 ******************************************************************************/

#include "uds_service36.h"


/*******************************************************************************
 * the defines
 ******************************************************************************/

/*******************************************************************************
 * the typedefs
 ******************************************************************************/

/*******************************************************************************
 * the globals
 ******************************************************************************/
 
static uint32_t s_memAddr = 0;
static uint32_t s_memSize = 0;
static UdsTransDirType s_dataTransDir = UDS_TRANSFER_DIR_NONE;

static uint8_t s_curRcvSequence = 0;
static uint8_t s_lastRcvSqunce = 0;
static uint32_t s_rcvDataTotalLen = 0;

/*******************************************************************************
 * the constants
 ******************************************************************************/

/*******************************************************************************
 * the functions
 ******************************************************************************/

void Uds_SetMemAddr(uint32_t addr)
{
    s_memAddr = addr;
}

uint32_t Uds_GetMemAddr(void)
{
    return s_memAddr;
}

void Uds_SetMemSize(uint32_t size)
{
    s_memSize = size;
}

uint32_t Uds_GetMemSize(void)
{
    return s_memSize;
}

void Uds_SetDataTransferDirect(UdsTransDirType dirType)
{
    s_dataTransDir = dirType;

    /* clear sequence number */
    s_lastRcvSqunce = 0x00;
    s_curRcvSequence = 0x00;

    /* clear receive data total number */
    s_rcvDataTotalLen = 0x00;
}

UdsTransDirType Uds_GetDataTransferDirect(void)
{
    return s_dataTransDir;
}

uint32_t Uds_GetRcvDataTotalLen(void)
{
    return s_rcvDataTotalLen;
}

void UdsService36_TransferData(UdsType *obj, const uint8_t msgBuf[], uint16_t msgLen)
{
    uint16_t rspLen = 0;
    uint8_t rspBuffer[UDS_RSP_LEN_MAX] = {0};   /* polyspace DEFECT:PARTIALLY_ACCESSED_ARRAY [No action planned:Low] "Still reserve though member2~511 is not written" */
    
    if(obj->session == UDS_SESSION_DEFAULT)
    {
        Uds_NegativeResponse(obj, 0x36, NRC_CONDITIONS_NOT_CORRECT);
        return;
    }
    
    if(msgLen < obj->seviceTable[obj->curServiceIdx].minLen)
    {
        Uds_NegativeResponse(obj, 0x36, NRC_INVALID_MESSAGE_LENGTH_OR_FORMAT);
        return;
    }    

    switch(s_dataTransDir)
    {
    case UDS_TRANSFER_DIR_DOWNLOAD:
        s_curRcvSequence = msgBuf[1];

        if((s_curRcvSequence != s_lastRcvSqunce) && (s_curRcvSequence != ((uint8_t)(s_lastRcvSqunce + 1))))
        {
            Uds_NegativeResponse(obj, 0x36, NRC_WRONG_BLOCK_SEQUENCE_COUNTER);
            return;
        }

        rspBuffer[rspLen++] = UDS_GET_POSITIVE_RSP(0x36);
        rspBuffer[rspLen++] = msgBuf[1];
        if(s_curRcvSequence == s_lastRcvSqunce)
        {
            Uds_PositiveResponse(obj, rspBuffer, rspLen);   
            return;
        }

        if((s_rcvDataTotalLen + msgLen - 2) > s_memSize)
        {
            Uds_NegativeResponse(obj, 0x36, NRC_TRANSFER_DATA_SUSPENDED);
            return;
        }

        /* user add code to deal with download data */
        /* polyspace-begin DEFECT:DEAD_CODE [No action planned:Low] "Still reserve though it's maybe unreachable" */
        if(1) /* deal success */
        {
            s_rcvDataTotalLen += msgLen - 2;
            s_lastRcvSqunce = s_curRcvSequence;
            Uds_PositiveResponse(obj, rspBuffer, rspLen);   
        }
        else
        {
            Uds_NegativeResponse(obj, 0x36, NRC_GENERAL_PROGRAMMING_FAILURE);
        }
        /* polyspace-end DEFECT:DEAD_CODE [No action planned:Low] "Still reserve though it's maybe unreachable" */
        break;
    case UDS_TRANSFER_DIR_UPLOAD:
        Uds_NegativeResponse(obj, 0x36, NRC_REQUEST_OUT_OF_RANGE);
        break;
    default:
        Uds_NegativeResponse(obj, 0x36, NRC_REQUEST_SEQUENCE_ERROR);
        break;
    }
}