// Copyright(c) 2018-2020, Intel Corporation
//
// Redistribution  and  use  in source  and  binary  forms,  with  or  without
// modification, are permitted provided that the following conditions are met:
//
// * Redistributions of  source code  must retain the  above copyright notice,
//   this list of conditions and the following disclaimer.
// * Redistributions in binary form must reproduce the above copyright notice,
//   this list of conditions and the following disclaimer in the documentation
//   and/or other materials provided with the distribution.
// * Neither the name  of Intel Corporation  nor the names of its contributors
//   may be used to  endorse or promote  products derived  from this  software
//   without specific prior written permission.
//
// THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
// AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING,  BUT NOT LIMITED TO,  THE
// IMPLIED WARRANTIES OF  MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
// ARE DISCLAIMED.  IN NO EVENT  SHALL THE COPYRIGHT OWNER  OR CONTRIBUTORS BE
// LIABLE  FOR  ANY  DIRECT,  INDIRECT,  INCIDENTAL,  SPECIAL,  EXEMPLARY,  OR
// CONSEQUENTIAL  DAMAGES  (INCLUDING,  BUT  NOT LIMITED  TO,  PROCUREMENT  OF
// SUBSTITUTE GOODS OR SERVICES;  LOSS OF USE,  DATA, OR PROFITS;  OR BUSINESS
// INTERRUPTION)  HOWEVER CAUSED  AND ON ANY THEORY  OF LIABILITY,  WHETHER IN
// CONTRACT,  STRICT LIABILITY,  OR TORT  (INCLUDING NEGLIGENCE  OR OTHERWISE)
// ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,  EVEN IF ADVISED OF THE
// POSSIBILITY OF SUCH DAMAGE.

#include "bmcdata.h"
#include <opae/fpga.h>
#ifndef _WIN32
#include <unistd.h>
#include <uuid/uuid.h>
#endif
#include <fcntl.h>
#include <sys/types.h>
#include <stdlib.h>
#include <stddef.h>
#include <string.h>
#include <wchar.h>

double getvalue(Values *val, uint8_t raw)
{
	int i;

	double res = val->M * raw + val->B;
	for (i = 0; i < abs(val->result_exp); i++) {
		if (val->result_exp >= 0) {
			res *= 10.0;
		} else {
			res /= 10.0;
		}
	}

	return res;
}

void calc_params(sdr_body *body, Values *val)
{
	int32_t i;
	int32_t M_val = 0;
	int32_t B_val = 0;
	uint32_t A_val = 0;
	uint32_t T_val = 0;
	uint32_t A_exp = 0;
	int32_t R_exp = 0;
	int32_t B_exp = 0;

#define SIGN_EXT(val, bitpos) (((val) ^ (1 << (bitpos))) - (1 << (bitpos)))

	B_val = (body->B_accuracy.bits.B_2_msb << 8) | body->B_8_lsb;
	B_val = SIGN_EXT(B_val, 9);

	M_val = (body->M_tolerance.bits.M_2_msb << 8) | body->M_8_lsb;
	M_val = SIGN_EXT(M_val, 9);

	A_val = (body->accuracy_accexp_sensor_direction.bits.accuracy_4_msb
		 << 6)
		| body->B_accuracy.bits.accuracy_6_lsb;

	T_val = body->M_tolerance.bits.tolerance;

	A_exp = body->accuracy_accexp_sensor_direction.bits.accuracy_exp;
	R_exp = body->R_exp_B_exp.bits.R_exp;
	R_exp = SIGN_EXT(R_exp, 3);
	B_exp = body->R_exp_B_exp.bits.B_exp;
	B_exp = SIGN_EXT(B_exp, 3);

	val->M = (double)M_val;
	val->tolerance = T_val;
	val->B = (double)B_val;
	val->result_exp = R_exp;
	val->A_exp = A_exp;
	for (i = 0; i < abs(B_exp); i++) {
		if (B_exp >= 0) {
			val->B *= 10.0;
		} else {
			val->B /= 10.0;
		}
	}

	val->accuracy = (double)A_val;
	for (i = 0; i < (int32_t)A_exp; i++) {
		val->accuracy *= 10.0;
	}
}