| 1 |
2 |
specular |
//=======================================================================
|
| 2 |
|
|
// Project Monophony
|
| 3 |
|
|
// Wire-Frame 3D Graphics Accelerator IP Core
|
| 4 |
|
|
//
|
| 5 |
|
|
// File:
|
| 6 |
|
|
// mp_vector4.h
|
| 7 |
|
|
//
|
| 8 |
|
|
// Abstract:
|
| 9 |
|
|
// vector4 implementation
|
| 10 |
|
|
//
|
| 11 |
|
|
// Author:
|
| 12 |
|
|
// Kenji Ishimaru (kenji.ishimaru@prtissimo.com)
|
| 13 |
|
|
//
|
| 14 |
|
|
//======================================================================
|
| 15 |
|
|
//
|
| 16 |
|
|
// Copyright (c) 2015, Kenji Ishimaru
|
| 17 |
|
|
// All rights reserved.
|
| 18 |
|
|
//
|
| 19 |
|
|
// Redistribution and use in source and binary forms, with or without
|
| 20 |
|
|
// modification, are permitted provided that the following conditions are met:
|
| 21 |
|
|
//
|
| 22 |
|
|
// -Redistributions of source code must retain the above copyright notice,
|
| 23 |
|
|
// this list of conditions and the following disclaimer.
|
| 24 |
|
|
// -Redistributions in binary form must reproduce the above copyright notice,
|
| 25 |
|
|
// this list of conditions and the following disclaimer in the documentation
|
| 26 |
|
|
// and/or other materials provided with the distribution.
|
| 27 |
|
|
//
|
| 28 |
|
|
// THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
|
| 29 |
|
|
// AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
|
| 30 |
|
|
// THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
|
| 31 |
|
|
// PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR
|
| 32 |
|
|
// CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
|
| 33 |
|
|
// EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
|
| 34 |
|
|
// PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
|
| 35 |
|
|
// OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
|
| 36 |
|
|
// WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
|
| 37 |
|
|
// OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
|
| 38 |
|
|
// EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
| 39 |
|
|
//
|
| 40 |
|
|
// Revision History
|
| 41 |
|
|
|
| 42 |
|
|
#include <math.h>
|
| 43 |
|
|
#include "mp_vector4.h"
|
| 44 |
|
|
|
| 45 |
|
|
void mp_vector4_init(mp_vector4 *dst) {
|
| 46 |
|
|
dst->x = 0.0;
|
| 47 |
|
|
dst->y = 0.0;
|
| 48 |
|
|
dst->z = 0.0;
|
| 49 |
|
|
dst->w = 0.0;
|
| 50 |
|
|
}
|
| 51 |
|
|
|
| 52 |
|
|
void mp_vector4_set0(mp_vector4 *dst, float lx, float ly, float lz) {
|
| 53 |
|
|
dst->x = lx;
|
| 54 |
|
|
dst->y = ly;
|
| 55 |
|
|
dst->z = lz;
|
| 56 |
|
|
dst->w = 1.0;
|
| 57 |
|
|
}
|
| 58 |
|
|
|
| 59 |
|
|
void mp_vector4_set1(mp_vector4 *dst, float lx, float ly,
|
| 60 |
|
|
float lz, float lw) {
|
| 61 |
|
|
dst->x = lx;
|
| 62 |
|
|
dst->y = ly;
|
| 63 |
|
|
dst->z = lz;
|
| 64 |
|
|
dst->w = lw;
|
| 65 |
|
|
}
|
| 66 |
|
|
|
| 67 |
|
|
void mp_vector4_set2(mp_vector4 *dst, mp_vector4 *v) {
|
| 68 |
|
|
dst->x = v->x;
|
| 69 |
|
|
dst->y = v->y;
|
| 70 |
|
|
dst->z = v->z;
|
| 71 |
|
|
dst->w = v->w;
|
| 72 |
|
|
}
|
| 73 |
|
|
|
| 74 |
|
|
void mp_vector4_normalize(mp_vector4 *dst) {
|
| 75 |
|
|
float t = dst->x*dst->x + dst->y*dst->y + dst->z*dst->z + dst->w*dst->w;
|
| 76 |
|
|
t = sqrt(t);
|
| 77 |
|
|
t = 1.0F/t;
|
| 78 |
|
|
dst->x = dst->x * t;
|
| 79 |
|
|
dst->y = dst->y * t;
|
| 80 |
|
|
dst->z = dst->z * t;
|
| 81 |
|
|
dst->w = dst->w * t;
|
| 82 |
|
|
}
|
| 83 |
|
|
|