[linux-2.6-block.git] / drivers / gpu / drm / amd / display / dc / basics / conversion.c

/*
 * Copyright 2012-15 Advanced Micro Devices, Inc.
 *
 * Permission is hereby granted, free of charge, to any person obtaining a
 * copy of this software and associated documentation files (the "Software"),
 * to deal in the Software without restriction, including without limitation
 * the rights to use, copy, modify, merge, publish, distribute, sublicense,
 * and/or sell copies of the Software, and to permit persons to whom the
 * Software is furnished to do so, subject to the following conditions:
 *
 * The above copyright notice and this permission notice shall be included in
 * all copies or substantial portions of the Software.
 *
 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT.  IN NO EVENT SHALL
 * THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
 * OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
 * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
 * OTHER DEALINGS IN THE SOFTWARE.
 *
 * Authors: AMD
 *
 */

#include "dm_services.h"
#include "conversion.h"

#define DIVIDER 10000

/* S2D13 value in [-3.00...0.9999] */
#define S2D13_MIN (-3 * DIVIDER)
#define S2D13_MAX (3 * DIVIDER)

uint16_t fixed_point_to_int_frac(
	struct fixed31_32 arg,
	uint8_t integer_bits,
	uint8_t fractional_bits)
{
	int32_t numerator;
	int32_t divisor = 1 << fractional_bits;

	uint16_t result;

	uint16_t d = (uint16_t)dc_fixpt_floor(
		dc_fixpt_abs(
			arg));

	if (d <= (uint16_t)(1 << integer_bits) - (1 / (uint16_t)divisor))
		numerator = (uint16_t)dc_fixpt_round(
			dc_fixpt_mul_int(
				arg,
				divisor));
	else {
		numerator = dc_fixpt_floor(
			dc_fixpt_sub(
				dc_fixpt_from_int(
					1LL << integer_bits),
				dc_fixpt_recip(
					dc_fixpt_from_int(
						divisor))));
	}

	if (numerator >= 0)
		result = (uint16_t)numerator;
	else
		result = (uint16_t)(
		(1 << (integer_bits + fractional_bits + 1)) + numerator);

	if ((result != 0) && dc_fixpt_lt(
		arg, dc_fixpt_zero))
		result |= 1 << (integer_bits + fractional_bits);

	return result;
}
/*
 * convert_float_matrix - This converts a double into HW register spec defined format S2D13.
 */
void convert_float_matrix(
	uint16_t *matrix,
	struct fixed31_32 *flt,
	uint32_t buffer_size)
{
	const struct fixed31_32 min_2_13 =
		dc_fixpt_from_fraction(S2D13_MIN, DIVIDER);
	const struct fixed31_32 max_2_13 =
		dc_fixpt_from_fraction(S2D13_MAX, DIVIDER);
	uint32_t i;

	for (i = 0; i < buffer_size; ++i) {
		uint32_t reg_value =
				fixed_point_to_int_frac(
					dc_fixpt_clamp(
						flt[i],
						min_2_13,
						max_2_13),
						2,
						13);

		matrix[i] = (uint16_t)reg_value;
	}
}

static uint32_t find_gcd(uint32_t a, uint32_t b)
{
	uint32_t remainder = 0;
	while (b != 0) {
		remainder = a % b;
		a = b;
		b = remainder;
	}
	return a;
}

void reduce_fraction(uint32_t num, uint32_t den,
		uint32_t *out_num, uint32_t *out_den)
{
	uint32_t gcd = 0;

	gcd = find_gcd(num, den);
	*out_num = num / gcd;
	*out_den = den / gcd;
}
Commit	Line	Data
4562236b HW	1	/*
	2	* Copyright 2012-15 Advanced Micro Devices, Inc.
	3	*
	4	* Permission is hereby granted, free of charge, to any person obtaining a
	5	* copy of this software and associated documentation files (the "Software"),
	6	* to deal in the Software without restriction, including without limitation
	7	* the rights to use, copy, modify, merge, publish, distribute, sublicense,
	8	* and/or sell copies of the Software, and to permit persons to whom the
	9	* Software is furnished to do so, subject to the following conditions:
	10	*
	11	* The above copyright notice and this permission notice shall be included in
	12	* all copies or substantial portions of the Software.
	13	*
	14	* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
	15	* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
	16	* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
	17	* THE COPYRIGHT HOLDER(S) OR AUTHOR(S) BE LIABLE FOR ANY CLAIM, DAMAGES OR
	18	* OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE,
	19	* ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR
	20	* OTHER DEALINGS IN THE SOFTWARE.
	21	*
	22	* Authors: AMD
	23	*
	24	*/
	25
	26	#include "dm_services.h"
ef80cb02	27	#include "conversion.h"
4562236b HW	28
	29	#define DIVIDER 10000
	30
	31	/* S2D13 value in [-3.00...0.9999] */
	32	#define S2D13_MIN (-3 * DIVIDER)
	33	#define S2D13_MAX (3 * DIVIDER)
	34
	35	uint16_t fixed_point_to_int_frac(
	36	struct fixed31_32 arg,
	37	uint8_t integer_bits,
	38	uint8_t fractional_bits)
	39	{
	40	int32_t numerator;
	41	int32_t divisor = 1 << fractional_bits;
	42
	43	uint16_t result;
	44
eb0e5154 DL	45	uint16_t d = (uint16_t)dc_fixpt_floor(
eb0e5154 DL	46	dc_fixpt_abs(
4562236b HW	47	arg));
	48
	49	if (d <= (uint16_t)(1 << integer_bits) - (1 / (uint16_t)divisor))
eb0e5154 DL	50	numerator = (uint16_t)dc_fixpt_round(
eb0e5154 DL	51	dc_fixpt_mul_int(
4562236b HW	52	arg,
	53	divisor));
	54	else {
eb0e5154 DL	55	numerator = dc_fixpt_floor(
	56	dc_fixpt_sub(
	57	dc_fixpt_from_int(
4562236b	58	1LL << integer_bits),
eb0e5154 DL	59	dc_fixpt_recip(
eb0e5154 DL	60	dc_fixpt_from_int(
4562236b HW	61	divisor))));
	62	}
	63
	64	if (numerator >= 0)
	65	result = (uint16_t)numerator;
	66	else
	67	result = (uint16_t)(
	68	(1 << (integer_bits + fractional_bits + 1)) + numerator);
	69
eb0e5154 DL	70	if ((result != 0) && dc_fixpt_lt(
eb0e5154 DL	71	arg, dc_fixpt_zero))
4562236b HW	72	result \|= 1 << (integer_bits + fractional_bits);
	73
	74	return result;
	75	}
4a531137 LJ	76	/*
	77	* convert_float_matrix - This converts a double into HW register spec defined format S2D13.
	78	*/
4562236b HW	79	void convert_float_matrix(
	80	uint16_t *matrix,
	81	struct fixed31_32 *flt,
	82	uint32_t buffer_size)
	83	{
	84	const struct fixed31_32 min_2_13 =
eb0e5154	85	dc_fixpt_from_fraction(S2D13_MIN, DIVIDER);
4562236b	86	const struct fixed31_32 max_2_13 =
eb0e5154	87	dc_fixpt_from_fraction(S2D13_MAX, DIVIDER);
4562236b HW	88	uint32_t i;
	89
	90	for (i = 0; i < buffer_size; ++i) {
	91	uint32_t reg_value =
	92	fixed_point_to_int_frac(
eb0e5154	93	dc_fixpt_clamp(
4562236b HW	94	flt[i],
	95	min_2_13,
	96	max_2_13),
	97	2,
	98	13);
	99
	100	matrix[i] = (uint16_t)reg_value;
	101	}
	102	}
fbe43dcd AL	103
	104	static uint32_t find_gcd(uint32_t a, uint32_t b)
	105	{
	106	uint32_t remainder = 0;
	107	while (b != 0) {
	108	remainder = a % b;
	109	a = b;
	110	b = remainder;
	111	}
	112	return a;
	113	}
	114
	115	void reduce_fraction(uint32_t num, uint32_t den,
	116	uint32_t out_num, uint32_t out_den)
	117	{
	118	uint32_t gcd = 0;
	119
	120	gcd = find_gcd(num, den);
	121	*out_num = num / gcd;
	122	*out_den = den / gcd;
	123	}