Project Ne10
An Open Optimized Software Library Project for the ARM Architecture
NE10_transmat.c
1 /*
2  * Copyright 2011-15 ARM Limited and Contributors.
3  * All rights reserved.
4  *
5  * Redistribution and use in source and binary forms, with or without
6  * modification, are permitted provided that the following conditions are met:
7  * * Redistributions of source code must retain the above copyright
8  * notice, this list of conditions and the following disclaimer.
9  * * Redistributions in binary form must reproduce the above copyright
10  * notice, this list of conditions and the following disclaimer in the
11  * documentation and/or other materials provided with the distribution.
12  * * Neither the name of ARM Limited nor the
13  * names of its contributors may be used to endorse or promote products
14  * derived from this software without specific prior written permission.
15  *
16  * THIS SOFTWARE IS PROVIDED BY ARM LIMITED AND CONTRIBUTORS "AS IS" AND
17  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
18  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
19  * DISCLAIMED. IN NO EVENT SHALL ARM LIMITED AND CONTRIBUTORS BE LIABLE FOR ANY
20  * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
21  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
22  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
23  * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
24  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
25  * SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
26  */
27 
28 /*
29  * NE10 Library : math/NE10_addmat.c
30  */
31 
32 #include "NE10_types.h"
33 #include "macros.h"
34 #include <math.h>
35 
36 #include <assert.h>
37 
38 inline void swap (ne10_float32_t *a, ne10_float32_t *b)
39 {
40  ne10_float32_t tmp = *a;
41  *a = *b;
42  *b = tmp;
43 }
44 
45 ne10_result_t ne10_transmat_2x2f_c (ne10_mat2x2f_t * dst, ne10_mat2x2f_t * src, ne10_uint32_t count)
46 {
47  NE10_DETMAT_OPERATION_X_C
48  (
49  dst[ itr ].c1.r1 = src[ itr ].c1.r1;
50  dst[ itr ].c1.r2 = src[ itr ].c2.r1;
51  dst[ itr ].c2.r1 = src[ itr ].c1.r2;
52  dst[ itr ].c2.r2 = src[ itr ].c2.r2;
53  );
54 }
55 
56 ne10_result_t ne10_transmat_3x3f_c (ne10_mat3x3f_t * dst, ne10_mat3x3f_t * src, ne10_uint32_t count)
57 {
58  NE10_DETMAT_OPERATION_X_C
59  (
60  dst[ itr ].c1.r1 = src[ itr ].c1.r1;
61  dst[ itr ].c1.r2 = src[ itr ].c2.r1;
62  dst[ itr ].c1.r3 = src[ itr ].c3.r1;
63 
64  dst[ itr ].c2.r1 = src[ itr ].c1.r2;
65  dst[ itr ].c2.r2 = src[ itr ].c2.r2;
66  dst[ itr ].c2.r3 = src[ itr ].c3.r2;
67 
68  dst[ itr ].c3.r1 = src[ itr ].c1.r3;
69  dst[ itr ].c3.r2 = src[ itr ].c2.r3;
70  dst[ itr ].c3.r3 = src[ itr ].c3.r3;
71  );
72 }
73 
74 ne10_result_t ne10_transmat_4x4f_c (ne10_mat4x4f_t * dst, ne10_mat4x4f_t * src, ne10_uint32_t count)
75 {
76  NE10_DETMAT_OPERATION_X_C
77  (
78  dst[ itr ].c1.r1 = src[ itr ].c1.r1;
79  dst[ itr ].c1.r2 = src[ itr ].c2.r1;
80  dst[ itr ].c1.r3 = src[ itr ].c3.r1;
81  dst[ itr ].c1.r4 = src[ itr ].c4.r1;
82 
83  dst[ itr ].c2.r1 = src[ itr ].c1.r2;
84  dst[ itr ].c2.r2 = src[ itr ].c2.r2;
85  dst[ itr ].c2.r3 = src[ itr ].c3.r2;
86  dst[ itr ].c2.r4 = src[ itr ].c4.r2;
87 
88  dst[ itr ].c3.r1 = src[ itr ].c1.r3;
89  dst[ itr ].c3.r2 = src[ itr ].c2.r3;
90  dst[ itr ].c3.r3 = src[ itr ].c3.r3;
91  dst[ itr ].c3.r4 = src[ itr ].c4.r3;
92 
93  dst[ itr ].c4.r1 = src[ itr ].c1.r4;
94  dst[ itr ].c4.r2 = src[ itr ].c2.r4;
95  dst[ itr ].c4.r3 = src[ itr ].c3.r4;
96  dst[ itr ].c4.r4 = src[ itr ].c4.r4;
97  );
98 }