diagnostic/Dcm/Dcm_Dsd.c

   1 /* -------------------------------- Arctic Core ------------------------------\r
   2  * Arctic Core - the open source AUTOSAR platform http://arccore.com\r
   3  *\r
   4  * Copyright (C) 2009  ArcCore AB <contact@arccore.com>\r
   5  *\r
   6  * This source code is free software; you can redistribute it and/or modify it\r
   7  * under the terms of the GNU General Public License version 2 as published by the\r
   8  * Free Software Foundation; See <http://www.gnu.org/licenses/old-licenses/gpl-2.0.txt>.\r
   9  *\r
  10  * This program is distributed in the hope that it will be useful, but\r
  11  * WITHOUT ANY WARRANTY; without even the implied warranty of MERCHANTABILITY\r
  12  * or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License\r
  13  * for more details.\r
  14  * -------------------------------- Arctic Core ------------------------------*/\r
  15 \r
  16 \r
  17 \r
  18 /*\r
  19  *  General requirements\r
  20  */\r
  21 /** @req DCM600 */ // Generated by BSW builder\r
  22 \r
  23 \r
  24 #include <string.h>\r
  25 #include "Dcm.h"\r
  26 #include "Dcm_Internal.h"\r
  27 #include "MemMap.h"\r
  28 \r
  29 typedef struct {\r
  30         const PduInfoType                               *pduRxData;\r
  31         PduInfoType                                     *pduTxData;\r
  32         const Dcm_DsdServiceTableType   *serviceTable;\r
  33         Dcm_ProtocolAddrTypeType                addrType;\r
  34         PduIdType                                               txPduId;\r
  35         PduIdType                                               rxPduId;\r
  36 } MsgDataType;\r
  37 \r
  38 // In "queue" to DSD\r
  39 static boolean  dsdDslDataIndication = FALSE;\r
  40 static MsgDataType msgData;\r
  41 \r
  42 static uint8    currentSid;\r
  43 static boolean  suppressPosRspMsg;\r
  44 \r
  45 /*\r
  46  * Local functions\r
  47  */\r
  48 \r
  49 \r
  50 static Std_ReturnType askApplicationForServicePermission(uint8 *requestData, uint16 dataSize)\r
  51 {\r
  52         Std_ReturnType returnCode = E_OK;\r
  53         const Dcm_DslServiceRequestIndicationType *serviceRequestIndication = DCM_Config.Dsl->DslServiceRequestIndication;\r
  54         Std_ReturnType result;\r
  55 \r
  56         while ((!serviceRequestIndication->Arc_EOL) && (returnCode != E_REQUEST_NOT_ACCEPTED)) {\r
  57                 if (serviceRequestIndication->Indication != NULL) {\r
  58                         result = serviceRequestIndication->Indication(requestData, dataSize);\r
  59                         if (result != E_OK){\r
  60                                 returnCode = result;\r
  61                         }\r
  62                 }\r
  63                 serviceRequestIndication++;\r
  64         }\r
  65 \r
  66         return returnCode;\r
  67 }\r
  68 \r
  69 \r
  70 static void createAndSendNcr(Dcm_NegativeResponseCodeType responseCode)\r
  71 {\r
  72         if (!((msgData.addrType == DCM_PROTOCOL_FUNCTIONAL_ADDR_TYPE)\r
  73                   && ((responseCode == DCM_E_SERVICENOTSUPPORTED) || (responseCode == DCM_E_SUBFUNCTIONNOTSUPPORTED) || (responseCode == DCM_E_REQUESTOUTOFRANGE)))) {   /** @req DCM001 */\r
  74                 msgData.pduTxData->SduDataPtr[0] = SID_NEGATIVE_RESPONSE;\r
  75                 msgData.pduTxData->SduDataPtr[1] = currentSid;\r
  76                 msgData.pduTxData->SduDataPtr[2] = responseCode;\r
  77                 msgData.pduTxData->SduLength = 3;\r
  78                 DslDsdProcessingDone(msgData.rxPduId, DSD_TX_RESPONSE_READY);   /** @req DCM114 */ /** @req DCM232.Ncr */\r
  79         }\r
  80         else {\r
  81                 DslDsdProcessingDone(msgData.rxPduId, DSD_TX_RESPONSE_SUPPRESSED);\r
  82         }\r
  83 }\r
  84 \r
  85 \r
  86 static void selectServiceFunction(uint8 sid)\r
  87 {\r
  88         /** @req DCM442.Partially */\r
  89         switch (sid)     /** @req DCM221 */\r
  90         {\r
  91         case SID_DIAGNOSTIC_SESSION_CONTROL:\r
  92                 DspUdsDiagnosticSessionControl(msgData.pduRxData, msgData.pduTxData);\r
  93                 break;\r
  94 \r
  95         case SID_ECU_RESET:\r
  96                 DspUdsEcuReset(msgData.pduRxData, msgData.txPduId, msgData.pduTxData);\r
  97                 break;\r
  98 \r
  99         case SID_CLEAR_DIAGNOSTIC_INFORMATION:\r
 100                 DspUdsClearDiagnosticInformation(msgData.pduRxData, msgData.pduTxData);\r
 101                 break;\r
 102 \r
 103         case SID_READ_DTC_INFORMATION:\r
 104                 DspUdsReadDtcInformation(msgData.pduRxData, msgData.pduTxData);\r
 105                 break;\r
 106 \r
 107         case SID_READ_DATA_BY_IDENTIFIER:\r
 108                 DspUdsReadDataByIdentifier(msgData.pduRxData, msgData.pduTxData);\r
 109                 break;\r
 110 \r
 111         case SID_READ_SCALING_DATA_BY_IDENTIFIER:\r
 112                 DspUdsReadScalingDataByIdentifier(msgData.pduRxData, msgData.pduTxData);\r
 113                 break;\r
 114 \r
 115         case SID_SECURITY_ACCESS:\r
 116                 DspUdsSecurityAccess(msgData.pduRxData, msgData.pduTxData);\r
 117                 break;\r
 118 \r
 119         case SID_WRITE_DATA_BY_IDENTIFIER:\r
 120                 DspUdsWriteDataByIdentifier(msgData.pduRxData, msgData.pduTxData);\r
 121                 break;\r
 122 \r
 123         case SID_ROUTINE_CONTROL:\r
 124                 DspUdsRoutineControl(msgData.pduRxData, msgData.pduTxData);\r
 125                 break;\r
 126 \r
 127         case SID_TESTER_PRESENT:\r
 128                 DspUdsTesterPresent(msgData.pduRxData, msgData.pduTxData);\r
 129                 break;\r
 130 \r
 131         case SID_CONTROL_DTC_SETTING:\r
 132                 DspUdsControlDtcSetting(msgData.pduRxData, msgData.pduTxData);\r
 133                 break;\r
 134 \r
 135         case SID_READ_DATA_BY_PERIODIC_IDENTIFIER:\r
 136         case SID_DYNAMICALLY_DEFINE_DATA_IDENTIFIER:\r
 137         case SID_INPUT_OUTPUT_CONTROL_BY_IDENTIFIER:\r
 138         default:\r
 139                 /* Non implemented service */\r
 140                 createAndSendNcr(DCM_E_SERVICENOTSUPPORTED);\r
 141                 break;\r
 142         }\r
 143 }\r
 144 \r
 145 \r
 146 static boolean lookupSid(uint8 sid, const Dcm_DsdServiceType **sidPtr)\r
 147 {\r
 148         boolean returnStatus = TRUE;\r
 149         const Dcm_DsdServiceType *service = msgData.serviceTable->DsdService;\r
 150 \r
 151         while ((service->DsdSidTabServiceId != sid) && (!service->Arc_EOL)) {\r
 152                 service++;\r
 153         }\r
 154 \r
 155         if (!service->Arc_EOL) {\r
 156                 *sidPtr = service;\r
 157         }\r
 158         else {\r
 159                 returnStatus = FALSE;\r
 160                 *sidPtr = NULL;\r
 161         }\r
 162 \r
 163         return returnStatus;\r
 164 }\r
 165 \r
 166 \r
 167 /*\r
 168  * Exported functions\r
 169  */\r
 170 \r
 171 void DsdInit(void)\r
 172 {\r
 173 \r
 174 }\r
 175 \r
 176 \r
 177 void DsdMain(void)\r
 178 {\r
 179         if (dsdDslDataIndication) {\r
 180                 dsdDslDataIndication = FALSE;\r
 181                 DsdHandleRequest();\r
 182         }\r
 183 }\r
 184 \r
 185 \r
 186 void DsdHandleRequest(void)\r
 187 {\r
 188         Std_ReturnType result;\r
 189         const Dcm_DsdServiceType *sidConfPtr = NULL;\r
 190 \r
 191         currentSid = msgData.pduRxData->SduDataPtr[0];  /** @req DCM198 */\r
 192 \r
 193         /** @req DCM178 */\r
 194         //lint --e(506, 774)    PC-Lint exception Misra 13.7, 14.1 Allow configuration variables in boolean expression\r
 195         if ((DCM_RESPOND_ALL_REQUEST == STD_ON) || ((currentSid & 0x7Fu) < 0x40)) {             /** @req DCM084 */\r
 196                 if (lookupSid(currentSid, &sidConfPtr)) {               /** @req DCM192 */ /** @req DCM193 */ /** @req DCM196 */\r
 197                         // SID found!\r
 198                         if (DspCheckSessionLevel(sidConfPtr->DsdSidTabSessionLevelRef)) {                /** @req DCM211 */\r
 199                                 if (DspCheckSecurityLevel(sidConfPtr->DsdSidTabSecurityLevelRef)) {      /** @req DCM217 */\r
 200                                         //lint --e(506, 774)    PC-Lint exception Misra 13.7, 14.1 Allow configuration variables in boolean expression\r
 201                                         if (DCM_REQUEST_INDICATION_ENABLED == STD_ON) {  /** @req DCM218 */\r
 202                                                  result = askApplicationForServicePermission(msgData.pduRxData->SduDataPtr, msgData.pduRxData->SduLength);\r
 203                                         } else {\r
 204                                                 result = E_OK;\r
 205                                         }\r
 206                                         //lint --e(506, 774)    PC-Lint exception Misra 13.7, 14.1 Allow configuration variables in boolean expression\r
 207                                         if (result == E_OK) {\r
 208                                                 // Yes! All conditions met!\r
 209                                                 // Check if response shall be suppressed\r
 210                                                 if ( (sidConfPtr->DsdSidTabSubfuncAvail) && (msgData.pduRxData->SduDataPtr[1] & SUPPRESS_POS_RESP_BIT) ) {      /** @req DCM204 */\r
 211                                                         suppressPosRspMsg = TRUE;       /** @req DCM202 */\r
 212                                                         msgData.pduRxData->SduDataPtr[1] &= ~SUPPRESS_POS_RESP_BIT;     /** @req DCM201 */\r
 213                                                 }\r
 214                                                 else\r
 215                                                 {\r
 216                                                         suppressPosRspMsg = FALSE;      /** @req DCM202 */\r
 217                                                 }\r
 218                                                 selectServiceFunction(currentSid);\r
 219                                         }\r
 220                                         else {\r
 221                                                 if (result == E_REQUEST_ENV_NOK) {\r
 222                                                         createAndSendNcr(DCM_E_CONDITIONSNOTCORRECT);   /** @req DCM463 */\r
 223                                                 }\r
 224                                                 else {\r
 225                                                         // Do not send any response             /** @req DCM462 */\r
 226                                                         DslDsdProcessingDone(msgData.rxPduId, DSD_TX_RESPONSE_SUPPRESSED);\r
 227                                                 }\r
 228                                         }\r
 229                                 }\r
 230                                 else {\r
 231                                         createAndSendNcr(DCM_E_SECUTITYACCESSDENIED);   /** @req DCM217 */\r
 232                                 }\r
 233                         }\r
 234                         else {\r
 235                                 createAndSendNcr(DCM_E_SERVICENOTSUPPORTEDINACTIVESESSION);     /** @req DCM211 */\r
 236                         }\r
 237                 }\r
 238                 else {\r
 239                         createAndSendNcr(DCM_E_SERVICENOTSUPPORTED);    /** @req DCM197 */\r
 240                 }\r
 241         }\r
 242         else {\r
 243                 // Inform DSL that message has been discard\r
 244                 DslDsdProcessingDone(msgData.rxPduId, DSD_TX_RESPONSE_SUPPRESSED);\r
 245         }\r
 246 }\r
 247 \r
 248 \r
 249 \r
 250 void DsdDspProcessingDone(Dcm_NegativeResponseCodeType responseCode)\r
 251 {\r
 252         if (responseCode == DCM_E_POSITIVERESPONSE) {\r
 253                 if (!suppressPosRspMsg) {       /** @req DCM200 */ /** @req DCM231 */\r
 254                         /** @req DCM222 */\r
 255                         msgData.pduTxData->SduDataPtr[0] = currentSid | SID_RESPONSE_BIT;       /** @req DCM223 */ /** @req DCM224 */\r
 256                         DslDsdProcessingDone(msgData.rxPduId, DSD_TX_RESPONSE_READY);   /** @req DCM114 */ /** @req DCM225 */ /** @req DCM232.Ok */\r
 257                 }\r
 258                 else {\r
 259                         DspDcmConfirmation(msgData.txPduId);    /** @req DCM236 */ /** @req DCM240 */\r
 260                         DslDsdProcessingDone(msgData.rxPduId, DSD_TX_RESPONSE_SUPPRESSED);\r
 261                 }\r
 262         }\r
 263         else {\r
 264                 createAndSendNcr(responseCode); /** @req DCM228 */\r
 265         }\r
 266 \r
 267 }\r
 268 \r
 269 \r
 270 void DsdDataConfirmation(PduIdType confirmPduId, NotifResultType result)\r
 271 {\r
 272         (void)result;   /* Currently not used */\r
 273         DspDcmConfirmation(confirmPduId);       /** @req DCM236 */\r
 274 }\r
 275 \r
 276 \r
 277 void DsdDslDataIndication(const PduInfoType *pduRxData, const Dcm_DsdServiceTableType *protocolSIDTable, Dcm_ProtocolAddrTypeType addrType, PduIdType txPduId, PduInfoType *pduTxData, PduIdType rxContextPduId)\r
 278 {\r
 279         msgData.rxPduId = rxContextPduId;\r
 280         msgData.txPduId = txPduId;\r
 281         msgData.pduRxData = pduRxData;\r
 282         msgData.pduTxData = pduTxData;\r
 283         msgData.addrType = addrType;\r
 284         msgData.serviceTable = protocolSIDTable;\r
 285 \r
 286         dsdDslDataIndication = TRUE;\r
 287 }\r