Subversion Repositories NaviCtrl

/******************** (C) COPYRIGHT 2008 STMicroelectronics ********************
* File Name          : usb_mem.c
* Author             : MCD Application Team
* Version            : V4.0.0
* Date               : 09/29/2008
* Description        : Utility functions for memory transfers to/from PMA.
********************************************************************************
* THE PRESENT FIRMWARE WHICH IS FOR GUIDANCE ONLY AIMS AT PROVIDING CUSTOMERS
* WITH CODING INFORMATION REGARDING THEIR PRODUCTS IN ORDER FOR THEM TO SAVE TIME.
* AS A RESULT, STMICROELECTRONICS SHALL NOT BE HELD LIABLE FOR ANY DIRECT,
* INDIRECT OR CONSEQUENTIAL DAMAGES WITH RESPECT TO ANY CLAIMS ARISING FROM THE
* CONTENT OF SUCH SOFTWARE AND/OR THE USE MADE BY CUSTOMERS OF THE CODING
* INFORMATION CONTAINED HEREIN IN CONNECTION WITH THEIR PRODUCTS.
*******************************************************************************/

/* Includes ------------------------------------------------------------------*/
#include "usb_lib.h"
#include "usb_mem.h"
#include "usb_conf.h"
/* Private typedef -----------------------------------------------------------*/
/* Private define ------------------------------------------------------------*/
/* Private macro -------------------------------------------------------------*/
/* Private variables ---------------------------------------------------------*/
/* Private function prototypes -----------------------------------------------*/
/* Private functions ---------------------------------------------------------*/

/*******************************************************************************
* Function Name  : UserToPMABufferCopy
* Description    : Copy a buffer from user memory area to packet memory area (PMA)
* Input          : - pbUsrBuf: pointer to user memory area.
*                  - wPMABufAddr: address into PMA.
*                  - wNBytes: no. of bytes to be copied.
* Output         : None.
* Return         : None .
*******************************************************************************/
void UserToPMABufferCopy(u8 *pbUsrBuf, u16 wPMABufAddr, u16 wNBytes)
{
#ifdef STR7xx                   /* STR7xx family    */
  u32 n = (wNBytes + 1) >> 1;   /* n=(wNBytes+1)/2  */
  u32 i, temp1, temp2;
  u16 *pdwVal;
  pdwVal = (u16 *)(wPMABufAddr * 2 + PMAAddr);

  for (i = n; i != 0; i--)
  {
    temp1 = (u16) * pbUsrBuf;
    pbUsrBuf++;
    temp2 = temp1 | (u16) * pbUsrBuf << 8;
    *pdwVal++ = temp2;
    pdwVal++;
    pbUsrBuf++;
  }
#endif                  /* End of STR7xx family*/

#ifdef STR91x           /*STR91x family*/

  u32 n = (wNBytes + 3) >> 2;  /*n=(wNBytes+1)/4*/
  u32 i, temp1, temp2, temp3, temp4;
  u32 *pdwVal;
  pdwVal = (u32 *)(PMAAddr + (u32)((wPMABufAddr)));
  for (i = n; i != 0; i--)
  {
    temp1 = (u32) * pbUsrBuf;
    temp2 = temp1 | (u32) * (pbUsrBuf + 1) << 8;
    temp3 = temp2 | (u32) * (pbUsrBuf + 2) << 16;
    temp4 = temp3 | (u32) * (pbUsrBuf + 3) << 24;
    pbUsrBuf += 4;
    *pdwVal = temp4;

    pdwVal++;
  }
#endif /* End of STR91x family*/
}
/*******************************************************************************
* Function Name  : PMAToUserBufferCopy
* Description    : Copy a buffer from user memory area to packet memory area (PMA)
* Input          : - pbUsrBuf    = pointer to user memory area.
*                  - wPMABufAddr = address into PMA.
*                  - wNBytes     = no. of bytes to be copied.
* Output         : None.
* Return         : None.
*******************************************************************************/
void PMAToUserBufferCopy(u8 *pbUsrBuf, u16 wPMABufAddr, u16 wNBytes)
{
#ifdef STR7xx /*STR7xx family*/
  u32 n = (wNBytes + 1) >> 1;/* /2*/
  u32 i;
  u32 *pdwVal;
  pdwVal = (u32 *)(wPMABufAddr * 2 + PMAAddr);
  for (i = n; i != 0; i--)
  {
    *pbUsrBuf++ = *(u8*)pdwVal;
    *pbUsrBuf++ = *((u8*)pdwVal + 1);
    pdwVal ++;  
  }

#endif /* End of STR7xx family*/

#ifdef STR91x  /*STR91x family*/
  u8 *pbVal;
  u16 wNTrasf = wNBytes;
  if ((wNBytes) == 0)
  {
    return;
  }
  pbVal = (u8 *)(PMAAddr + wPMABufAddr);
  while (1)
  {
    *pbUsrBuf++ = *pbVal++;
    if ((--wNTrasf) == 0)
    {
      return;
    }
    *pbUsrBuf++ = *pbVal++;
    if ((--wNTrasf) == 0)
    {
      return;
    }
  }
#endif /* End of STR91x family*/
}
/******************* (C) COPYRIGHT 2008 STMicroelectronics *****END OF FILE****/