1 /*
2  * Copyright (C) 2008 The Android Open Source Project
3  *
4  * Licensed under the Apache License, Version 2.0 (the "License");
5  * you may not use this file except in compliance with the License.
6  * You may obtain a copy of the License at
7  *
8  *      http://www.apache.org/licenses/LICENSE-2.0
9  *
10  * Unless required by applicable law or agreed to in writing, software
11  * distributed under the License is distributed on an "AS IS" BASIS,
12  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13  * See the License for the specific language governing permissions and
14  * limitations under the License.
15  */
16 
17 /* ---- includes ----------------------------------------------------------- */
18 
19 #include "b_TensorEm/Int16Vec3D.h"
20 #include "b_BasicEm/Functions.h"
21 #include "b_BasicEm/Math.h"
22 #include "b_BasicEm/Memory.h"
23 
24 /* ------------------------------------------------------------------------- */
25 
26 /* ========================================================================= */
27 /*                                                                           */
28 /* ---- \ghd{ auxiliary functions } ---------------------------------------- */
29 /*                                                                           */
30 /* ========================================================================= */
31 
32 /* ------------------------------------------------------------------------- */
33 
34 /* ========================================================================= */
35 /*                                                                           */
36 /* ---- \ghd{ constructor / destructor } ----------------------------------- */
37 /*                                                                           */
38 /* ========================================================================= */
39 
40 /* ------------------------------------------------------------------------- */
41 
42 /* ========================================================================= */
43 /*                                                                           */
44 /* ---- \ghd{ operators } -------------------------------------------------- */
45 /*                                                                           */
46 /* ========================================================================= */
47 
48 /* ------------------------------------------------------------------------- */
49 
50 /* ========================================================================= */
51 /*                                                                           */
52 /* ---- \ghd{ query functions } -------------------------------------------- */
53 /*                                                                           */
54 /* ========================================================================= */
55 
56 /* ------------------------------------------------------------------------- */
57 
58 /* ========================================================================= */
59 /*                                                                           */
60 /* ---- \ghd{ modify functions } ------------------------------------------- */
61 /*                                                                           */
62 /* ========================================================================= */
63 
64 /* ------------------------------------------------------------------------- */
65 
66 /* ========================================================================= */
67 /*                                                                           */
68 /* ---- \ghd{ I/O } -------------------------------------------------------- */
69 /*                                                                           */
70 /* ========================================================================= */
71 
72 /* ------------------------------------------------------------------------- */
73 
bts_Int16Vec3D_memSize(struct bbs_Context * cpA,const struct bts_Int16Vec3D * ptrA)74 uint32 bts_Int16Vec3D_memSize( struct bbs_Context* cpA,
75 							   const struct bts_Int16Vec3D *ptrA )
76 {
77 	return bbs_SIZEOF16( struct bts_Int16Vec3D );
78 }
79 
80 /* ------------------------------------------------------------------------- */
81 
bts_Int16Vec3D_memWrite(struct bbs_Context * cpA,const struct bts_Int16Vec3D * ptrA,uint16 * memPtrA)82 uint32 bts_Int16Vec3D_memWrite( struct bbs_Context* cpA,
83 							    const struct bts_Int16Vec3D* ptrA,
84 								uint16* memPtrA )
85 {
86 	memPtrA += bbs_memWrite16( &ptrA->xE, memPtrA );
87 	memPtrA += bbs_memWrite16( &ptrA->yE, memPtrA );
88 	memPtrA += bbs_memWrite16( &ptrA->zE, memPtrA );
89 	return bbs_SIZEOF16( *ptrA );
90 }
91 
92 /* ------------------------------------------------------------------------- */
93 
bts_Int16Vec3D_memRead(struct bbs_Context * cpA,struct bts_Int16Vec3D * ptrA,const uint16 * memPtrA)94 uint32 bts_Int16Vec3D_memRead( struct bbs_Context* cpA,
95 							   struct bts_Int16Vec3D* ptrA,
96 							   const uint16* memPtrA )
97 {
98 	if( bbs_Context_error( cpA ) ) return 0;
99 	memPtrA += bbs_memRead16( &ptrA->xE, memPtrA );
100 	memPtrA += bbs_memRead16( &ptrA->yE, memPtrA );
101 	memPtrA += bbs_memRead16( &ptrA->zE, memPtrA );
102 	return bbs_SIZEOF16( *ptrA );
103 }
104 
105 /* ------------------------------------------------------------------------- */
106 
107 /* ========================================================================= */
108 /*                                                                           */
109 /* ---- \ghd{ exec functions } --------------------------------------------- */
110 /*                                                                           */
111 /* ========================================================================= */
112 
113 /* ------------------------------------------------------------------------- */
114 
bts_Int16Vec3D_norm2(const struct bts_Int16Vec3D * ptrA)115 uint32 bts_Int16Vec3D_norm2( const struct bts_Int16Vec3D* ptrA )
116 {
117 	return ( int32 ) ptrA->xE * ptrA->xE +
118 		   ( int32 ) ptrA->yE * ptrA->yE +
119 		   ( int32 ) ptrA->zE * ptrA->zE;
120 }
121 
122 /* ------------------------------------------------------------------------- */
123 
bts_Int16Vec3D_norm(const struct bts_Int16Vec3D * ptrA)124 uint16 bts_Int16Vec3D_norm( const struct bts_Int16Vec3D* ptrA )
125 {
126 	return bbs_sqrt32( ( int32 ) ptrA->xE * ptrA->xE +
127 					   ( int32 ) ptrA->yE * ptrA->yE +
128 					   ( int32 ) ptrA->zE * ptrA->zE );
129 }
130 
131 /* ------------------------------------------------------------------------- */
132 
bts_Int16Vec3D_normalize(struct bts_Int16Vec3D * ptrA,int32 bbpA)133 void bts_Int16Vec3D_normalize( struct bts_Int16Vec3D* ptrA, int32 bbpA )
134 {
135 	int32 normL = bbs_sqrt32( ( int32 ) ptrA->xE * ptrA->xE +
136 							  ( int32 ) ptrA->yE * ptrA->yE +
137 							  ( int32 ) ptrA->zE * ptrA->zE );
138 
139 	int32 xL = ( ( int32 )ptrA->xE << 16 ) / normL;
140 	int32 yL = ( ( int32 )ptrA->yE << 16 ) / normL;
141 	int32 zL = ( ( int32 )ptrA->zE << 16 ) / normL;
142 	ptrA->xE = xL >> ( 16 - bbpA );
143 	ptrA->yE = yL >> ( 16 - bbpA );
144 	ptrA->zE = zL >> ( 16 - bbpA );
145 }
146 
147 /* ------------------------------------------------------------------------- */
148 
bts_Int16Vec3D_normalized(const struct bts_Int16Vec3D * ptrA,int32 bbpA)149 struct bts_Int16Vec3D bts_Int16Vec3D_normalized( const struct bts_Int16Vec3D* ptrA, int32 bbpA )
150 {
151 	struct bts_Int16Vec3D vecL = *ptrA;
152 	bts_Int16Vec3D_normalize( &vecL, bbpA );
153 	return vecL;
154 }
155 
156 /* ------------------------------------------------------------------------- */
157 
158 /* ========================================================================= */
159 
160