Loading...
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"
27
28#define DIVIDER 10000
29
30/* S2D13 value in [-3.00...0.9999] */
31#define S2D13_MIN (-3 * DIVIDER)
32#define S2D13_MAX (3 * DIVIDER)
33
34uint16_t fixed_point_to_int_frac(
35 struct fixed31_32 arg,
36 uint8_t integer_bits,
37 uint8_t fractional_bits)
38{
39 int32_t numerator;
40 int32_t divisor = 1 << fractional_bits;
41
42 uint16_t result;
43
44 uint16_t d = (uint16_t)dc_fixpt_floor(
45 dc_fixpt_abs(
46 arg));
47
48 if (d <= (uint16_t)(1 << integer_bits) - (1 / (uint16_t)divisor))
49 numerator = (uint16_t)dc_fixpt_round(
50 dc_fixpt_mul_int(
51 arg,
52 divisor));
53 else {
54 numerator = dc_fixpt_floor(
55 dc_fixpt_sub(
56 dc_fixpt_from_int(
57 1LL << integer_bits),
58 dc_fixpt_recip(
59 dc_fixpt_from_int(
60 divisor))));
61 }
62
63 if (numerator >= 0)
64 result = (uint16_t)numerator;
65 else
66 result = (uint16_t)(
67 (1 << (integer_bits + fractional_bits + 1)) + numerator);
68
69 if ((result != 0) && dc_fixpt_lt(
70 arg, dc_fixpt_zero))
71 result |= 1 << (integer_bits + fractional_bits);
72
73 return result;
74}
75/**
76* convert_float_matrix
77* This converts a double into HW register spec defined format S2D13.
78* @param :
79* @return None
80*/
81void convert_float_matrix(
82 uint16_t *matrix,
83 struct fixed31_32 *flt,
84 uint32_t buffer_size)
85{
86 const struct fixed31_32 min_2_13 =
87 dc_fixpt_from_fraction(S2D13_MIN, DIVIDER);
88 const struct fixed31_32 max_2_13 =
89 dc_fixpt_from_fraction(S2D13_MAX, DIVIDER);
90 uint32_t i;
91
92 for (i = 0; i < buffer_size; ++i) {
93 uint32_t reg_value =
94 fixed_point_to_int_frac(
95 dc_fixpt_clamp(
96 flt[i],
97 min_2_13,
98 max_2_13),
99 2,
100 13);
101
102 matrix[i] = (uint16_t)reg_value;
103 }
104}
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"
27#include "conversion.h"
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
35uint16_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
45 uint16_t d = (uint16_t)dc_fixpt_floor(
46 dc_fixpt_abs(
47 arg));
48
49 if (d <= (uint16_t)(1 << integer_bits) - (1 / (uint16_t)divisor))
50 numerator = (uint16_t)dc_fixpt_round(
51 dc_fixpt_mul_int(
52 arg,
53 divisor));
54 else {
55 numerator = dc_fixpt_floor(
56 dc_fixpt_sub(
57 dc_fixpt_from_int(
58 1LL << integer_bits),
59 dc_fixpt_recip(
60 dc_fixpt_from_int(
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
70 if ((result != 0) && dc_fixpt_lt(
71 arg, dc_fixpt_zero))
72 result |= 1 << (integer_bits + fractional_bits);
73
74 return result;
75}
76/*
77 * convert_float_matrix - This converts a double into HW register spec defined format S2D13.
78 */
79void 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 =
85 dc_fixpt_from_fraction(S2D13_MIN, DIVIDER);
86 const struct fixed31_32 max_2_13 =
87 dc_fixpt_from_fraction(S2D13_MAX, DIVIDER);
88 uint32_t i;
89
90 for (i = 0; i < buffer_size; ++i) {
91 uint32_t reg_value =
92 fixed_point_to_int_frac(
93 dc_fixpt_clamp(
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}
103
104static 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
115void 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}