Subversion Repositories s6soc

////////////////////////////////////////////////////////////////////////////
//
// Filename: 	twoc.cpp
//
// Project:	Zip CPU -- a small, lightweight, RISC CPU soft core
//
// Purpose:	Some various two's complement related C++ helper routines.
//		Specifically, these help extract signed numbers from
//		packed bitfields, while guaranteeing that the upper bits
//		are properly sign extended (or not) as desired.
//
// Creator:	Dan Gisselquist, Ph.D.
//		Gisselquist Technology, LLC
//
///////////////////////////////////////////////////////////////////////////
//
// Copyright (C) 2015, Gisselquist Technology, LLC
//
// This program is free software (firmware): 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 3 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 MERCHANTIBILITY 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.  (It's in the $(ROOT)/doc directory, run make with no
// target there if the PDF file isn't present.)  If not, see
// <http://www.gnu.org/licenses/> for a copy.
//
// License:	GPL, v3, as defined and found on www.gnu.org,
//		http://www.gnu.org/licenses/gpl.html
//
//
///////////////////////////////////////////////////////////////////////////
#include <stdio.h>
#include <assert.h>
#include "twoc.h"
 
long	sbits(const long val, const int bits) {
	long	r;
 
	r = val & ((1l<<bits)-1);
	if (r & (1l << (bits-1)))
		r |= (-1l << bits);
	return r;
}
 
bool	sfits(const long val, const int bits) {
	long	alt = sbits(val, bits);
	return (sbits(val, bits) == bits);
}
 
unsigned long	ubits(const long val, const int bits) {
	unsigned long r = val & ((1l<<bits)-1);
	return r;
}
 
unsigned long	rndbits(const long val, const int bits_in, const int bits_out) {
	long	s = sbits(val, bits_in); // Signed input value
	long	t = s;	// Truncated input value
	long	r;	// Result
 
	// printf("RNDBITS(%08lx, %d, %d)\n", val, bits_in, bits_out);
	// printf("S = %lx\n", s);
	// printf("T = %lx\n", t);
	// assert(bits_in > bits_out);
	if (bits_in == bits_out)
		r = s;
	else if (bits_in-1 == bits_out) {
		t = sbits(val>>1, bits_out);
		// printf("TEST! S = %ld, T = %ld\n", s, t);
		if (3 == (s&3))
			t = t+1;
		r = t;
	} else {
		// A. 0XXXX.0xxxxx -> 0XXXX
		// B. 0XXX0.100000 -> 0XXX0;
		// C. 0XXX1.100000 -> 0XXX1+1;
		// D. 0XXXX.1zzzzz -> 0XXXX+1;
		// E. 1XXXX.0xxxxx -> 1XXXX
		// F. 1XXX0.100000 ->  ??? XXX0;
		// G. 1XXX1.100000 ->  ??? XXX1+1;
		// H. 1XXXX.1zzzzz -> 1XXXX+1;
		t = sbits(val>>(bits_in-bits_out), bits_out); // Truncated value
		if (0 == ((s >> (bits_in-bits_out-1))&1)) {
			// printf("A\n");
			r = t;
		} else if (0 != (s & ((1<<(bits_in-bits_out-1))-1))) {
			// printf("D\n");
			r = t+1;
		} else if (t&1) {
			// printf("C\n");
			r = t+1;
		} else { // 3 ..?11
			// printf("B\n");
			r = t;
		}
	} return r;
}