Subversion Repositories qaz_libs

//////////////////////////////////////////////////////////////////////
////                                                              ////
//// Copyright (C) 2015 Authors and OPENCORES.ORG                 ////
////                                                              ////
//// This source file may be used and distributed without         ////
//// restriction provided that this copyright statement is not    ////
//// removed from the file and that any derivative work contains  ////
//// the original copyright notice and the associated disclaimer. ////
////                                                              ////
//// This source file 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 2.1 of the License, or (at your option) any   ////
//// later version.                                               ////
////                                                              ////
//// This source 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 source; if not, download it   ////
//// from http://www.opencores.org/lgpl.shtml                     ////
////                                                              ////
//////////////////////////////////////////////////////////////////////
 
#include "util_bits.h"
 
 
/*-----------------------------------------------------------*/
void inline 
  util_set_bits
  (
    unsigned int address, 
    unsigned int bit_offset, 
    unsigned int bit_mask, 
    unsigned int data
  )
{
  volatile unsigned int *word_pointer = (volatile unsigned int *)(address);
  unsigned int buffer;
 
  data <<= bit_offset;
  data &= bit_mask;
 
  buffer = *word_pointer;
  buffer &= ~bit_mask;
  buffer |= data;
 
  *word_pointer = buffer;
}
 
 
/*-----------------------------------------------------------*/
unsigned int inline 
  util_get_bits
  (
    unsigned int address, 
    unsigned int bit_offset, 
    unsigned int bit_mask
  )
{
  volatile unsigned int *word_pointer = (volatile unsigned int *)(address);
  unsigned int buffer;
 
  buffer = *word_pointer;
  buffer &= bit_mask;
  buffer >>= bit_offset;
 
  return(buffer);
}
 
 
/*-----------------------------------------------------------*/
unsigned char ReverseBits7ops32bit(unsigned char v)
{
    return ((v * 0x0802LU & 0x22110LU) |
            (v * 0x8020LU & 0x88440LU)) * 0x10101LU >> 16;
}