/* * Copyright (C) 2008 The Android Open Source Project * * Licensed under the Apache License, Version 2.0 (the "License"); * you may not use this file except in compliance with the License. * You may obtain a copy of the License at * * http://www.apache.org/licenses/LICENSE-2.0 * * Unless required by applicable law or agreed to in writing, software * distributed under the License is distributed on an "AS IS" BASIS, * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. * See the License for the specific language governing permissions and * limitations under the License. */ /* ---- includes ----------------------------------------------------------- */ #include "b_TensorEm/Int16Vec2D.h" #include "b_BasicEm/Math.h" #include "b_BasicEm/Memory.h" #include "b_BasicEm/Functions.h" /* ------------------------------------------------------------------------- */ /* ========================================================================= */ /* */ /* ---- \ghd{ auxiliary functions } ---------------------------------------- */ /* */ /* ========================================================================= */ /* ------------------------------------------------------------------------- */ /* ========================================================================= */ /* */ /* ---- \ghd{ constructor / destructor } ----------------------------------- */ /* */ /* ========================================================================= */ /* ------------------------------------------------------------------------- */ void bts_Int16Vec2D_init( struct bts_Int16Vec2D* ptrA ) { ptrA->xE = 0; ptrA->yE = 0; } /* ------------------------------------------------------------------------- */ void bts_Int16Vec2D_exit( struct bts_Int16Vec2D* ptrA ) { ptrA->xE = 0; ptrA->yE = 0; } /* ------------------------------------------------------------------------- */ /* ========================================================================= */ /* */ /* ---- \ghd{ operators } -------------------------------------------------- */ /* */ /* ========================================================================= */ /* ------------------------------------------------------------------------- */ /* ========================================================================= */ /* */ /* ---- \ghd{ query functions } -------------------------------------------- */ /* */ /* ========================================================================= */ /* ------------------------------------------------------------------------- */ /* ========================================================================= */ /* */ /* ---- \ghd{ modify functions } ------------------------------------------- */ /* */ /* ========================================================================= */ /* ------------------------------------------------------------------------- */ /* ========================================================================= */ /* */ /* ---- \ghd{ I/O } -------------------------------------------------------- */ /* */ /* ========================================================================= */ /* ------------------------------------------------------------------------- */ uint32 bts_Int16Vec2D_memSize( struct bbs_Context* cpA, const struct bts_Int16Vec2D *ptrA ) { return bbs_SIZEOF16( struct bts_Int16Vec2D ); } /* ------------------------------------------------------------------------- */ uint32 bts_Int16Vec2D_memWrite( struct bbs_Context* cpA, const struct bts_Int16Vec2D* ptrA, uint16* memPtrA ) { memPtrA += bbs_memWrite16( &ptrA->xE, memPtrA ); memPtrA += bbs_memWrite16( &ptrA->yE, memPtrA ); return bbs_SIZEOF16( *ptrA ); } /* ------------------------------------------------------------------------- */ uint32 bts_Int16Vec2D_memRead( struct bbs_Context* cpA, struct bts_Int16Vec2D* ptrA, const uint16* memPtrA ) { if( bbs_Context_error( cpA ) ) return 0; memPtrA += bbs_memRead16( &ptrA->xE, memPtrA ); memPtrA += bbs_memRead16( &ptrA->yE, memPtrA ); return bbs_SIZEOF16( *ptrA ); } /* ------------------------------------------------------------------------- */ /* ========================================================================= */ /* */ /* ---- \ghd{ exec functions } --------------------------------------------- */ /* */ /* ========================================================================= */ /* ------------------------------------------------------------------------- */ int32 bts_Int16Vec2D_dotPrd( const struct bts_Int16Vec2D* vec1PtrA, const struct bts_Int16Vec2D* vec2PtrA ) { return ( int32 ) vec1PtrA->xE * vec2PtrA->xE + ( int32 ) vec1PtrA->yE * vec2PtrA->yE; } /* ------------------------------------------------------------------------- */ uint32 bts_Int16Vec2D_norm2( const struct bts_Int16Vec2D* ptrA ) { return ( int32 ) ptrA->xE * ptrA->xE + ( int32 ) ptrA->yE * ptrA->yE; } /* ------------------------------------------------------------------------- */ uint16 bts_Int16Vec2D_norm( const struct bts_Int16Vec2D* ptrA ) { return bbs_sqrt32( ( int32 ) ptrA->xE * ptrA->xE + ( int32 ) ptrA->yE * ptrA->yE ); } /* ------------------------------------------------------------------------- */ void bts_Int16Vec2D_normalize( struct bts_Int16Vec2D* ptrA, int32 bbpA ) { int32 normL = bbs_sqrt32( ( int32 ) ptrA->xE * ptrA->xE + ( int32 ) ptrA->yE * ptrA->yE ); int32 xL = ( ( int32 ) ptrA->xE << 16 ) / normL; int32 yL = ( ( int32 ) ptrA->yE << 16 ) / normL; ptrA->xE = xL >> ( 16 - bbpA ); ptrA->yE = yL >> ( 16 - bbpA ); } /* ------------------------------------------------------------------------- */ struct bts_Int16Vec2D bts_Int16Vec2D_normalized( const struct bts_Int16Vec2D* ptrA, int32 bbpA ) { struct bts_Int16Vec2D vecL = *ptrA; bts_Int16Vec2D_normalize( &vecL, bbpA ); return vecL; } /* ------------------------------------------------------------------------- */ phase16 bts_Int16Vec2D_angle( const struct bts_Int16Vec2D* vecPtrA ) { return bbs_phase16( vecPtrA->xE, vecPtrA->yE ); } /* ------------------------------------------------------------------------- */ phase16 bts_Int16Vec2D_enclosedAngle( const struct bts_Int16Vec2D* vec1PtrA, const struct bts_Int16Vec2D* vec2PtrA ) { int32 xL = ( int32 ) vec1PtrA->xE * vec2PtrA->xE + ( int32 ) vec1PtrA->yE * vec2PtrA->yE; int32 yL = ( int32 ) vec1PtrA->yE * vec2PtrA->xE - ( int32 ) vec1PtrA->xE * vec2PtrA->yE; return bbs_phase16( xL, yL ); } /* ------------------------------------------------------------------------- */ /* ========================================================================= */