c_move.c

Go to the documentation of this file.

/*
 * LEGO® MINDSTORMS EV3
 *
 * Copyright (C) 2010-2013 The LEGO Group
 *
 * 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., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
 */


#include  <math.h>
#include  "lms2012.h"
#include  "c_move.h"


//******* BYTE CODE SNIPPETS **************************************************

void      cMoveInitBytes(void)
{
  DATA8   *pDestination;
  DATA32  Length;

  pDestination  =  (DATA8*)PrimParPointer();
  Length        = *(DATA32*)PrimParPointer();

  while (Length)
  {
    *pDestination  =  *(DATA8*)PrimParPointer();
    pDestination++;
    Length--;
  }
}


void      cMove8to8(void)
{
  DATA8   Tmp;

  Tmp  =  *(DATA8*)PrimParPointer();
  *(DATA8*)PrimParPointer()  =  Tmp;
}


void      cMove8to16(void)
{
  DATA8   Tmp;

  Tmp  =  *(DATA8*)PrimParPointer();

  if (Tmp != DATA8_NAN)
  {
    *(DATA16*)PrimParPointer()  =  (DATA16)Tmp;
  }
  else
  {
    *(DATA16*)PrimParPointer()  =  DATA16_NAN;
  }
}


void      cMove8to32(void)
{
  DATA8   Tmp;

  Tmp  =  *(DATA8*)PrimParPointer();
  if (Tmp != DATA8_NAN)
  {
    *(DATA32*)PrimParPointer()  =  (DATA32)Tmp;
  }
  else
  {
    *(DATA32*)PrimParPointer()  =  DATA32_NAN;
  }
}


void      cMove8toF(void)
{
  DATA8   Tmp;

  Tmp  =  *(DATA8*)PrimParPointer();
  if (Tmp != DATA8_NAN)
  {
    *(DATAF*)PrimParPointer()  =  (DATAF)Tmp;
  }
  else
  {
    *(DATAF*)PrimParPointer()  =  DATAF_NAN;
  }
}


void      cMove16to8(void)
{
  DATA16  Tmp;

  Tmp  =  *(DATA16*)PrimParPointer();
  if (Tmp != DATA16_NAN)
  {
    if (Tmp > (DATA16)DATA8_MAX)
    {
      Tmp  =  (DATA16)DATA8_MAX;
    }
    if (Tmp < (DATA16)DATA8_MIN)
    {
      Tmp  =  (DATA16)DATA8_MIN;
    }
    *(DATA8*)PrimParPointer()  =  (DATA8)Tmp;
  }
  else
  {
    *(DATA8*)PrimParPointer()  =  DATA8_NAN;
  }
}


void      cMove16to16(void)
{
  DATA16  Tmp;

  Tmp  =  *(DATA16*)PrimParPointer();
  *(DATA16*)PrimParPointer()  =  Tmp;
}


void      cMove16to32(void)
{
  DATA16  Tmp;

  Tmp  =  *(DATA16*)PrimParPointer();
  if (Tmp != DATA16_NAN)
  {
    *(DATA32*)PrimParPointer()  =  (DATA32)Tmp;
  }
  else
  {
    *(DATA32*)PrimParPointer()  =  DATA32_NAN;
  }
}


void      cMove16toF(void)
{
  DATA16  Tmp;

  Tmp  =  *(DATA16*)PrimParPointer();
  if (Tmp != DATA16_NAN)
  {
    *(DATAF*)PrimParPointer()  =  (DATAF)Tmp;
  }
  else
  {
    *(DATAF*)PrimParPointer()  =  DATAF_NAN;
  }
}


void      cMove32to8(void)
{
  DATA32  Tmp;

  Tmp  =  *(DATA32*)PrimParPointer();
  if (Tmp != DATA32_NAN)
  {
    if (Tmp > (DATA32)DATA8_MAX)
    {
      Tmp  =  (DATA32)DATA8_MAX;
    }
    if (Tmp < (DATA32)DATA8_MIN)
    {
      Tmp  =  (DATA32)DATA8_MIN;
    }
    *(DATA8*)PrimParPointer()  =  (DATA8)Tmp;
  }
  else
  {
    *(DATA8*)PrimParPointer()  =  DATA8_NAN;
  }
}


void      cMove32to16(void)
{
  DATA32  Tmp;

  Tmp  =  *(DATA32*)PrimParPointer();
  if (Tmp != DATA32_NAN)
  {
    if (Tmp > (DATA32)DATA16_MAX)
    {
      Tmp  =  (DATA32)DATA16_MAX;
    }
    if (Tmp < (DATA32)DATA16_MIN)
    {
      Tmp  =  (DATA32)DATA16_MIN;
    }
    *(DATA16*)PrimParPointer()  =  (DATA16)Tmp;
  }
  else
  {
    *(DATA16*)PrimParPointer()  =  DATA16_NAN;
  }
}


void      cMove32to32(void)
{
  DATA32  Tmp;

  Tmp  =  *(DATA32*)PrimParPointer();
  *(DATA32*)PrimParPointer()  =  Tmp;
}


void      cMove32toF(void)
{
  DATA32  Tmp;

  Tmp  =  *(DATA32*)PrimParPointer();
  if (Tmp != DATA32_NAN)
  {
    *(DATAF*)PrimParPointer()  =  (DATAF)Tmp;
  }
  else
  {
    *(DATAF*)PrimParPointer()  =  DATAF_NAN;
  }
}


void      cMoveFto8(void)
{
  DATAF   Tmp;

  Tmp  =  *(DATAF*)PrimParPointer();
  if (!(isnan(Tmp)))
  {
    if (Tmp > (DATAF)DATA8_MAX)
    {
      Tmp  =  (DATAF)DATA8_MAX;
    }
    if (Tmp < (DATAF)DATA8_MIN)
    {
      Tmp  =  (DATAF)DATA8_MIN;
    }
    *(DATA8*)PrimParPointer()  =  (DATA8)Tmp;
  }
  else
  {
    *(DATA8*)PrimParPointer()  =  DATA8_NAN;
  }
}


void      cMoveFto16(void)
{
  DATAF   Tmp;

  Tmp  =  *(DATAF*)PrimParPointer();
  if (!(isnan(Tmp)))
  {
    if (Tmp > (DATAF)DATA16_MAX)
    {
      Tmp  =  (DATAF)DATA16_MAX;
    }
    if (Tmp < (DATAF)DATA16_MIN)
    {
      Tmp  =  (DATAF)DATA16_MIN;
    }
    *(DATA16*)PrimParPointer()  =  (DATA16)Tmp;
  }
  else
  {
    *(DATA16*)PrimParPointer()  =  DATA16_NAN;
  }
}


void      cMoveFto32(void)
{
  DATAF   Tmp;

  Tmp  =  *(DATAF*)PrimParPointer();
  if (!(isnan(Tmp)))
  {
    if (Tmp > (DATAF)DATA32_MAX)
    {
      Tmp  =  (DATAF)DATA32_MAX;
    }
    if (Tmp < (DATAF)DATA32_MIN)
    {
      Tmp  =  (DATAF)DATA32_MIN;
    }
    *(DATA32*)PrimParPointer()  =  (DATA32)Tmp;
  }
  else
  {
    *(DATA32*)PrimParPointer()  =  DATA32_NAN;
  }
}


void      cMoveFtoF(void)
{
  DATAF   Tmp;

  Tmp  =  *(DATAF*)PrimParPointer();
  *(DATAF*)PrimParPointer()  =  Tmp;
}


void      cMoveRead8(void)
{
  DATA8   *pTmp;
  DATA8   Index;

  pTmp    =  (DATA8*)PrimParPointer();
  Index   = *(DATA8*)PrimParPointer();
  *(DATA8*)PrimParPointer()  =  pTmp[Index];
}


void      cMoveRead16(void)
{
  DATA16  *pTmp;
  DATA8   Index;

  pTmp    =  (DATA16*)PrimParPointer();
  Index   = *(DATA8*)PrimParPointer();
  *(DATA16*)PrimParPointer()  =  pTmp[Index];
}


void      cMoveRead32(void)
{
  DATA32  *pTmp;
  DATA8   Index;

  pTmp    =  (DATA32*)PrimParPointer();
  Index   = *(DATA8*)PrimParPointer();
  *(DATA32*)PrimParPointer()  =  pTmp[Index];
}


void      cMoveReadF(void)
{
  DATAF   *pTmp;
  DATA8   Index;

  pTmp    =  (DATAF*)PrimParPointer();
  Index   = *(DATA8*)PrimParPointer();
  *(DATAF*)PrimParPointer()  =  pTmp[Index];
}


void      cMoveWrite8(void)
{
  DATA8   Tmp;
  DATA8   *pTmp;
  DATA8   Index;

  Tmp     = *(DATA8*)PrimParPointer();
  Index   = *(DATA8*)PrimParPointer();
  pTmp    =  (DATA8*)PrimParPointer();
  pTmp[Index]  =  Tmp;
}


void      cMoveWrite16(void)
{
  DATA16  Tmp;
  DATA16  *pTmp;
  DATA8   Index;

  Tmp     = *(DATA16*)PrimParPointer();
  Index   = *(DATA8*)PrimParPointer();
  pTmp    =  (DATA16*)PrimParPointer();
  pTmp[Index]  =  Tmp;
}


void      cMoveWrite32(void)
{
  DATA32  Tmp;
  DATA32  *pTmp;
  DATA8   Index;

  Tmp     = *(DATA32*)PrimParPointer();
  Index   = *(DATA8*)PrimParPointer();
  pTmp    =  (DATA32*)PrimParPointer();
  pTmp[Index]  =  Tmp;
}


void      cMoveWriteF(void)
{
  DATAF   Tmp;
  DATAF   *pTmp;
  DATA8   Index;

  Tmp     = *(DATAF*)PrimParPointer();
  Index   = *(DATA8*)PrimParPointer();
  pTmp    =  (DATAF*)PrimParPointer();
  pTmp[Index]  =  Tmp;
}


//*****************************************************************************