path: root/c/src/lib/libbsp/mips/malta/startup/simple_access.c

/**
 *  @file
 *
 *  This file contains the code to do simple memory and io accesses.
 */

/*
 *  COPYRIGHT (c) 1989-2012.
 *  On-Line Applications Research Corporation (OAR).
 *
 *  The license and distribution terms for this file may be
 *  found in the file LICENSE in this distribution or at
 *  http://www.rtems.org/license/LICENSE.
 */

#include <rtems.h>
#include <bsp.h>

#include <bsp/pci.h>
#include <bsp/irq.h>
#include <rtems/bspIo.h>
#include <rtems/endian.h>
// #define DEBUG_ACCESSES   1

#ifdef DEBUG_ACCESSES
  #define JPRINTK(fmt, ...) printk("%s: " fmt, __FUNCTION__, ##__VA_ARGS__)
#else
  #define JPRINTK(fmt, ...)
#endif

/*
 *  *  Simple accesses
 *   */
void simple_out_32(uint32_t base, uint32_t addr, uint32_t val)
{
  volatile uint32_t *ptr;

  ptr = (volatile uint32_t *) (base + addr);
  *ptr = val;

  JPRINTK( "%p data: 0x%x\n", ptr, val);
}

void simple_out_le32(uint32_t base, uint32_t addr, uint32_t val)
{
  volatile uint32_t *ptr;
  uint32_t           data = 0;

  ptr = (volatile uint32_t *) (base + addr);
  rtems_uint32_to_little_endian( val, (uint8_t *) &data);
  *ptr = data;

  JPRINTK( "%p data: 0x%x\n", ptr, data);
}

uint8_t simple_in_8( uint32_t base, uint32_t addr ) {
  volatile uint8_t *ptr;
  uint8_t           val;

  ptr = (volatile uint8_t *) (base + addr);
  val = *ptr;
  JPRINTK( "0x%x data: 0x%x\n", ptr, val);

  return val;
}

int16_t simple_in_le16( uint32_t base, uint32_t addr ) {
  volatile uint16_t *ptr;
  uint16_t           val;
  uint16_t           rval;

  ptr = (volatile uint16_t *) (base + addr);
  val = *ptr;
  rval = rtems_uint16_from_little_endian( (uint8_t *) &val);
  JPRINTK( "0x%x data: 0x%x raw: 0x%x\n", ptr, rval, val);
  return rval;
}

int16_t simple_in_16( uint32_t base, uint32_t addr ) {
  volatile uint16_t *ptr;
  uint16_t           val;

  ptr = (volatile uint16_t *) (base + addr);
  val = *ptr;
  JPRINTK( "0x%x data: 0x%x raw: 0x%x\n", ptr, val, val);
  return val;
}

uint32_t simple_in_le32( uint32_t base, uint32_t addr ) {
  volatile uint32_t *ptr;
  uint32_t           val;
  uint32_t           rval;

  ptr = (volatile uint32_t *) (base + addr);
  val = *ptr;
  rval = rtems_uint32_from_little_endian( (uint8_t *) &val);
  JPRINTK( "0x%x data: 0x%x raw: 0x%x\n", ptr, rval, val);
  return rval;
}

uint32_t simple_in_32( uint32_t base, uint32_t addr ) {
  volatile uint32_t *ptr;
  uint32_t           val;

  ptr = (volatile uint32_t *) (base + addr);
  val = *ptr;
  JPRINTK( "0x%x data: 0x%x raw: 0x%x\n", ptr, val, val);
  return val;
}

void simple_out_8( uint32_t base, uint32_t addr, uint8_t val ) {
  volatile uint8_t *ptr;

  ptr = (volatile uint8_t *) (base | addr);
  JPRINTK( "0x%x data: 0x%x\n", ptr, val);
  *ptr = val;
}

void simple_out_le16( uint32_t base, uint32_t addr, uint16_t val ) {
  volatile uint16_t *ptr;
  uint16_t           data;
  ptr = (volatile uint16_t *) (base + addr);
  rtems_uint16_to_little_endian( val, (uint8_t *) &data);
  *ptr = data;
  JPRINTK( "0x%x data: 0x%x\n", ptr, data);
}

void simple_out_16( uint32_t base, uint32_t addr, uint16_t val ) {
  volatile uint16_t *ptr;
  ptr = (volatile uint16_t *) (base + addr);
  *ptr = val;
  JPRINTK( "0x%x data: 0x%x\n", ptr, val);
}