Subversion Repositories yac

/* -------------------------------------------------------------------

 *

 *

 *

 *   File           : yac.c

 *   Project        : YAC (Yet Another CORDIC Core)

 *   Creation       : Jun. 2015

 *   Limitations    :

 *   Synthesizer    :

 *   Target         :

 *

 *   Author(s):     : Christian Haettich

 *   Email          : feddischson@opencores.org

 *

 *

 *

 *

 *   Description

 *        Implementation of functions to access the yac.

 *

 *

 *

 *

 *

 *

 *

 *  -------------------------------------------------------------------

 *

 *                   Copyright Notice

 *

 *  This file is part of YAC - Yet Another CORDIC Core

 *  Copyright (c) 2015, Author(s), All rights reserved.

 *

 *  YAC is free software; you can redistribute it and/or

 *  modify it under the terms of the GNU Lesser General Public

 *  License as published by the Free Software Foundation; either

 *  version 3.0 of the License, or (at your option) any later version.

 *

 *  YAC 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

 *  Lesser General Public License for more details.

 *

 *  You should have received a copy of the GNU Lesser General Public

 *  License along with this library. If not, download it from

 *  http://www.gnu.org/licenses/lgpl

 *

 *  -------------------------------------------------------------------

 */

#include "yac.h"

#define REG32(adr) *((volatile unsigned long *)(adr))

void yac_init( YAC * yac,

               uint32_t   base,

               uint32_t   xy_width,

               uint32_t   a_width,

               uint8_t    rm_gain,

               uint16_t   entries )

{

  yac->base         = base;

  yac->xy_width     = xy_width;

  yac->a_width      = a_width;

  yac->rm_gain      = rm_gain;

  yac->entries      = entries;

  yac->status_reg   = base + ( entries<<4);

}

void yac_single( YAC * yac,

                 int32_t * x_i,

                 int32_t * y_i,

                 int32_t * z_i,

                 int32_t * x_o,

                 int32_t * y_o,

                 int32_t * z_o,

                 uint8_t * mode )

{

    REG32( yac->base + 0   ) =  *x_i;

    REG32( yac->base + 4   ) =  *y_i;

    REG32( yac->base + 8   ) =  *z_i;

    REG32( yac->base + 12  ) = *mode;

    REG32( yac->status_reg ) = (1<<YAC_ENTRIES_SHIFT) | 1;

    /* busy wait loop until the yac is done */

    while( REG32( yac->status_reg ) & 1 );

    *x_o = REG32( yac->base + 0 );

    *y_o = REG32( yac->base + 4 );

    *z_o = REG32( yac->base + 8 );

}