git.sur5r.net Git - freertos/blob - FreeRTOS/Demo/CORTEX_A53_64-bit_UltraScale_MPSoC/RTOSDemo_A53_bsp/psu_cortexa53_0/libsrc/nandpsu_v1_0/src/xnandpsu_onfi.c

   1 /******************************************************************************
   2 *
   3 * Copyright (C) 2015 Xilinx, Inc. All rights reserved.
   4 *
   5 * Permission is hereby granted, free of charge, to any person obtaining a copy
   6 * of this software and associated documentation files (the "Software"), to deal
   7 * in the Software without restriction, including without limitation the rights
   8 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
   9 * copies of the Software, and to permit persons to whom the Software is
  10 * furnished to do so, subject to the following conditions:
  11 *
  12 * The above copyright notice and this permission notice shall be included in
  13 * all copies or substantial portions of the Software.
  14 *
  15 * Use of the Software is limited solely to applications:
  16 * (a) running on a Xilinx device, or
  17 * (b) that interact with a Xilinx device through a bus or interconnect.
  18 *
  19 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  20 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  21 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
  22 * XILINX  BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY,
  23 * WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF
  24 * OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  25 * SOFTWARE.
  26 *
  27 * Except as contained in this notice, the name of the Xilinx shall not be used
  28 * in advertising or otherwise to promote the sale, use or other dealings in
  29 * this Software without prior written authorization from Xilinx.
  30 *
  31 ******************************************************************************/
  32 /*****************************************************************************/
  33 /**
  34 *
  35 * @file xnandpsu_onfi.c
  36 *
  37 * This file contains the implementation of ONFI specific functions.
  38 *
  39 * @note         None
  40 *
  41 * <pre>
  42 * MODIFICATION HISTORY:
  43 *
  44 * Ver   Who    Date        Changes
  45 * ----- ----   ----------  -----------------------------------------------
  46 * 1.0   nm     05/06/2014  First release
  47 * </pre>
  48 *
  49 ******************************************************************************/
  50
  51 /***************************** Include Files *********************************/
  52 #include "xnandpsu_onfi.h"
  53 #include "xnandpsu.h"
  54
  55 /************************** Constant Definitions *****************************/
  56
  57 /**************************** Type Definitions *******************************/
  58
  59 /***************** Macros (Inline Functions) Definitions *********************/
  60
  61 /************************** Function Prototypes ******************************/
  62
  63 /*****************************************************************************/
  64 /**
  65 *
  66 * This function calculates ONFI paramater page CRC.
  67 *
  68 * @param        Parambuf is a pointer to the ONFI paramater page buffer.
  69 * @param        StartOff is the starting offset in buffer to calculate CRC.
  70 * @param        Length is the number of bytes for which CRC is calculated.
  71 *
  72 * @return
  73 *               CRC value.
  74 * @note
  75 *               None.
  76 *
  77 ******************************************************************************/
  78 u32 XNandPsu_OnfiParamPageCrc(u8 *ParamBuf, u32 StartOff, u32 Length)
  79 {
  80         const u32 CrcInit = 0x4F4EU;
  81         const u32 Order = 16U;
  82         const u32 Polynom = 0x8005U;
  83         u32 i, j, c, Bit;
  84         u32 Crc = CrcInit;
  85         u32 DataIn;
  86         u32 DataByteCount = 0U;
  87         u32 CrcMask, CrcHighBit;
  88
  89         CrcMask = ((u32)(((u32)1 << (Order - (u32)1)) -(u32)1) << (u32)1) | (u32)1;
  90         CrcHighBit = (u32)((u32)1 << (Order - (u32)1));
  91         /*
  92          * CRC covers the data bytes between byte 0 and byte 253
  93          * (ONFI 1.0, section 5.4.1.36)
  94          */
  95         for(i = StartOff; i < Length; i++) {
  96                 DataIn = ParamBuf[i];
  97                 c = (u32)DataIn;
  98                 DataByteCount++;
  99                 for(j = 0x80U; j; j >>= 1U) {
 100                         Bit = Crc & CrcHighBit;
 101                         Crc <<= 1U;
 102                         if ((c & j) != 0U) {
 103                                 Bit ^= CrcHighBit;
 104                         }
 105                         if (Bit != 0U) {
 106                                 Crc ^= Polynom;
 107                         }
 108                 }
 109                 Crc &= CrcMask;
 110         }
 111         return Crc;
 112 }