123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249 |
- /******************************************************************************
- * Copyright (C) 2021 NXP
- * *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License as published by
- * the Free Software Foundation; either version 2 of the License, or
- * (at your option) any later version.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License
- * along with this program; if not, write to the Free Software
- * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
- *
- ******************************************************************************/
- #include "recovery_seq.h"
- struct recovery_info g_recovery_info;
- struct recovery_frame g_recovery_frame;
- /** @brief Function to calculate crc value.
- *
- * @param pbuffer: input buffer for crc calculation.
- * dwLength: length of input buffer
- * @return calculated uint16_t crc valueof input buffer.
- */
- static uint16_t calcCrc16(uint8_t *pbuffer, uint32_t dwLength)
- {
- uint32_t i = 0;
- uint16_t crc_new = 0;
- uint16_t crc = DL_INVALID_CRC_VALUE;
- if (pbuffer == NULL) {
- pr_err("%s, invalid params", __func__);
- return crc;
- }
- for (i = 0; i < dwLength; i++) {
- crc_new = (uint8_t)(crc >> MSB_POS) | (crc << MSB_POS);
- crc_new ^= pbuffer[i];
- crc_new ^= (uint8_t)(crc_new & DL_CRC_MASK) >> 4;
- crc_new ^= crc_new << 12;
- crc_new ^= (crc_new & DL_CRC_MASK) << 5;
- crc = crc_new;
- }
- return crc;
- }
- /** @brief Function to build command frame for recover.
- *
- * @return status code of recovery_status type.
- */
- static enum recovery_status build_cmd_frame(void)
- {
- uint16_t len = 0;
- uint16_t wCrc = 0;
- uint16_t writeOffset = 0;
- pr_debug(" %s Entry", __func__);
- if (gphDnldNfc_DlSeqSz == 0) {
- pr_err(" %s invalid params", __func__);
- return STATUS_FAILED;
- }
- memset(g_recovery_frame.p_buffer, 0x00, MAX_FRAME_SIZE);
- g_recovery_frame.len = 0;
- if (g_recovery_info.bFrameSegmented == false) {
- len = gphDnldNfc_DlSequence[g_recovery_info.currentReadOffset];
- len <<= MSB_POS;
- len |= gphDnldNfc_DlSequence[g_recovery_info.currentReadOffset + 1];
- } else {
- /* last frame was segmented frame
- * read length reamaining length
- */
- len = g_recovery_info.wRemChunkBytes;
- }
- if (len > MAX_DATA_SIZE) {
- /* set remaining chunk */
- g_recovery_info.wRemChunkBytes = (len - MAX_DATA_SIZE);
- len = MAX_DATA_SIZE;
- /* set chunk bit to write in header */
- len = DL_SET_HDR_FRAGBIT(len);
- g_recovery_frame.p_buffer[writeOffset++] = (len >> MSB_POS) & SHIFT_MASK;
- g_recovery_frame.p_buffer[writeOffset++] = len & SHIFT_MASK;
- /* clear chunk bit for length variable */
- len = DL_CLR_HDR_FRAGBIT(len);
- /* first chunk of segmented frame*/
- if (!g_recovery_info.bFrameSegmented) {
- /* ignore header from user buffer */
- g_recovery_info.currentReadOffset += FW_HDR_LEN;
- g_recovery_info.remBytes -= FW_HDR_LEN;
- }
- g_recovery_frame.len += FW_HDR_LEN;
- g_recovery_info.bFrameSegmented = true;
- } else {
- /* last chunk of segmented frame */
- if (g_recovery_info.bFrameSegmented) {
- /* write header with user chunk length */
- g_recovery_frame.p_buffer[writeOffset++] = (len >> MSB_POS) & SHIFT_MASK;
- g_recovery_frame.p_buffer[writeOffset++] = len & SHIFT_MASK;
- g_recovery_frame.len += FW_HDR_LEN;
- } else {
- /* normal Frame with in supported size increase
- * len to read header from user data
- */
- len += FW_HDR_LEN;
- }
- g_recovery_info.wRemChunkBytes = 0;
- g_recovery_info.bFrameSegmented = false;
- }
- if (((writeOffset + len) > MAX_FRAME_SIZE) ||
- ((g_recovery_info.currentReadOffset + len) > gphDnldNfc_DlSeqSz)) {
- pr_err("%s frame offsets out of bound", __func__);
- return STATUS_FAILED;
- }
- memcpy(&g_recovery_frame.p_buffer[writeOffset],
- &gphDnldNfc_DlSequence[g_recovery_info.currentReadOffset], len);
- g_recovery_info.currentReadOffset += len;
- g_recovery_frame.len += len;
- writeOffset += len;
- g_recovery_info.remBytes -= len;
- wCrc = calcCrc16(g_recovery_frame.p_buffer,
- g_recovery_frame.len);
- g_recovery_frame.p_buffer[writeOffset++] = (wCrc >> MSB_POS) & SHIFT_MASK;
- g_recovery_frame.p_buffer[writeOffset++] = wCrc & SHIFT_MASK;
- g_recovery_frame.len += FW_CRC_LEN;
- return STATUS_SUCCESS;
- }
- /** @brief Function to transmit recovery frame.
- * @param nfc_dev nfc driver object.
- * @return status code of recovery_status type.
- */
- static enum recovery_status transmit(struct nfc_dev *nfc_dev)
- {
- int ret = 0;
- int frame_resp_len = 0;
- uint16_t respCRC = 0;
- uint16_t respCRCOffset = 0;
- uint8_t *rsp_buf = nfc_dev->read_kbuf;
- pr_debug("%s Entry", __func__);
- if (nfc_dev == NULL || g_recovery_frame.len <= 0) {
- pr_err("%s invalid Params", __func__);
- return STATUS_FAILED;
- }
- ret = nfc_dev->nfc_write(nfc_dev, g_recovery_frame.p_buffer,
- g_recovery_frame.len, MAX_RETRY_COUNT);
- if (ret <= 0) {
- pr_err(" %s: Write recovery frame error %d\n", __func__, ret);
- return STATUS_FAILED;
- }
- pr_debug(" %s Reading response\n", __func__);
- memset(rsp_buf, 0x00, MAX_BUFFER_SIZE);
- ret = nfc_dev->nfc_read(nfc_dev, rsp_buf, FW_HDR_LEN, NCI_CMD_RSP_TIMEOUT);
- if (ret < FW_HDR_LEN) {
- pr_err(" %s - Read recovery frame response error ret %d\n", __func__, ret);
- return STATUS_FAILED;
- }
- if (rsp_buf[0] != FW_MSG_CMD_RSP ||
- rsp_buf[DL_FRAME_RESP_LEN_OFFSET] != DL_FRAME_RESP_LEN) {
- pr_err("%s, invalid response", __func__);
- return STATUS_FAILED;
- }
- frame_resp_len = rsp_buf[DL_FRAME_RESP_LEN_OFFSET] + FW_CRC_LEN;
- ret = nfc_dev->nfc_read(nfc_dev, rsp_buf + FW_HDR_LEN, frame_resp_len, NCI_CMD_RSP_TIMEOUT);
- if (ret < frame_resp_len) {
- pr_err(" %s - Read recovery frame response error ret %d\n", __func__, ret);
- return STATUS_FAILED;
- }
- pr_debug(" %s: recovery frame Response 0x%02x 0x%02x 0x%02x 0x%02x 0x%02x 0x%02x\n",
- __func__, rsp_buf[0], rsp_buf[1], rsp_buf[2], rsp_buf[3], rsp_buf[4], rsp_buf[5]);
- respCRCOffset = FW_HDR_LEN + rsp_buf[DL_FRAME_RESP_LEN_OFFSET];
- respCRC = rsp_buf[respCRCOffset++];
- respCRC <<= MSB_POS;
- respCRC |= rsp_buf[respCRCOffset];
- if (respCRC != calcCrc16(rsp_buf, DL_FRAME_RESP_LEN + FW_HDR_LEN)) {
- pr_err("%s, invalid response crc", __func__);
- return STATUS_FAILED;
- }
- if (g_recovery_info.bFrameSegmented &&
- (rsp_buf[DL_FRAME_RESP_STAT_OFFSET] != DL_SEGMENTED_FRAME_RESP_STAT1
- && rsp_buf[DL_FRAME_RESP_STAT_OFFSET] != DL_SEGMENTED_FRAME_RESP_STAT2)) {
- pr_err("%s, invalid stat flag in chunk response", __func__);
- return STATUS_FAILED;
- }
- if (!g_recovery_info.bFrameSegmented &&
- rsp_buf[DL_FRAME_RESP_STAT_OFFSET] != DL_NON_SEGMENTED_FRAME_RESP_STAT) {
- pr_err("%s, invalid stat flag in response", __func__);
- return STATUS_FAILED;
- }
- return STATUS_SUCCESS;
- }
- /** @brief Function to check input version with recovery fw version.
- * @param fw_major_version: input major_version to check.
- * @return true if input major_version matches with recovery fw major version
- * otherwise returns false.
- */
- static bool check_major_version(uint8_t fw_major_version)
- {
- if (gphDnldNfc_DlSeqSz < RECOVERY_FW_MJ_VER_OFFSET) {
- /* Recovery data corrupted */
- pr_err("%s Not able to extract major version from recovery fw\n", __func__);
- return false;
- }
- return (fw_major_version == gphDnldNfc_DlSequence[RECOVERY_FW_MJ_VER_OFFSET]);
- }
- /** @brief Function to recover the nfcc.
- * @param nfc_dev nfc driver object.
- * @return status code of type recovery_status.
- */
- enum recovery_status do_recovery(struct nfc_dev *nfc_dev)
- {
- enum recovery_status status = STATUS_SUCCESS;
- g_recovery_info.remBytes = gphDnldNfc_DlSeqSz;
- g_recovery_info.currentReadOffset = 0;
- g_recovery_info.bFrameSegmented = false;
- g_recovery_info.wRemChunkBytes = 0;
- g_recovery_frame.p_buffer = nfc_dev->write_kbuf;
- pr_debug("%s Entry", __func__);
- if (nfc_dev == NULL) {
- pr_err("%s invalid params ", __func__);
- return STATUS_FAILED;
- }
- if (!(check_major_version(nfc_dev->fw_major_version))) {
- pr_err("%s unsupported version", __func__);
- status = STATUS_FAILED;
- goto EXIT_RECOVERY;
- }
- while (g_recovery_info.remBytes > 0) {
- status = build_cmd_frame();
- if (status != STATUS_SUCCESS) {
- pr_err(" %s Unable to create recovery frame");
- break;
- }
- status = transmit(nfc_dev);
- if (status != STATUS_SUCCESS) {
- pr_err(" %s Unable to send recovery frame");
- break;
- }
- }
- EXIT_RECOVERY:
- pr_info("%s Recovery done status %d", __func__, status);
- return status;
- }
|