Assert Style
This commit is contained in:
@@ -48,7 +48,8 @@ extern volatile unsigned char animate_index;
|
|||||||
static inline
|
static inline
|
||||||
#endif
|
#endif
|
||||||
|
|
||||||
void main_loop(void)
|
void
|
||||||
|
main_loop(void)
|
||||||
{
|
{
|
||||||
quat_t q;
|
quat_t q;
|
||||||
|
|
||||||
|
|||||||
@@ -207,26 +207,30 @@ static void __calculate_normal(
|
|||||||
Calculate a normal vector of a plain using Gram-Schmidt process
|
Calculate a normal vector of a plain using Gram-Schmidt process
|
||||||
*/
|
*/
|
||||||
{
|
{
|
||||||
for (i = 0; i < n; ++i) {
|
for (i = 0; i < n; ++i)
|
||||||
|
{
|
||||||
v1[i] = p2[i] - p1[i];
|
v1[i] = p2[i] - p1[i];
|
||||||
v2[i] = p3[i] - p1[i];
|
v2[i] = p3[i] - p1[i];
|
||||||
v3[i] = p1[i];
|
v3[i] = p1[i];
|
||||||
}
|
}
|
||||||
|
|
||||||
for (i = 0; i < n; ++i) {
|
for (i = 0; i < n; ++i)
|
||||||
|
{
|
||||||
u1[i] = v1[i];
|
u1[i] = v1[i];
|
||||||
}
|
}
|
||||||
|
|
||||||
{
|
{
|
||||||
float proj[n];
|
float proj[n];
|
||||||
float dot_v2_u1 = 0.0f, dot_u1_u1 = 0.0f;
|
float dot_v2_u1 = 0.0f, dot_u1_u1 = 0.0f;
|
||||||
for (i = 0; i < n; ++i) {
|
for (i = 0; i < n; ++i)
|
||||||
|
{
|
||||||
dot_v2_u1 += v2[i] * u1[i];
|
dot_v2_u1 += v2[i] * u1[i];
|
||||||
dot_u1_u1 += u1[i] * u1[i];
|
dot_u1_u1 += u1[i] * u1[i];
|
||||||
}
|
}
|
||||||
alpha = dot_v2_u1 / dot_u1_u1;
|
alpha = dot_v2_u1 / dot_u1_u1;
|
||||||
|
|
||||||
for (i = 0; i < n; ++i) {
|
for (i = 0; i < n; ++i)
|
||||||
|
{
|
||||||
proj[i] = u1[i] * alpha;
|
proj[i] = u1[i] * alpha;
|
||||||
u2[i] = v2[i] - proj[i];
|
u2[i] = v2[i] - proj[i];
|
||||||
}
|
}
|
||||||
@@ -237,31 +241,37 @@ static void __calculate_normal(
|
|||||||
float dot_v3_u1 = 0.0f, dot_u1_u1 = 0.0f;
|
float dot_v3_u1 = 0.0f, dot_u1_u1 = 0.0f;
|
||||||
float dot_v3_u2 = 0.0f, dot_u2_u2 = 0.0f;
|
float dot_v3_u2 = 0.0f, dot_u2_u2 = 0.0f;
|
||||||
|
|
||||||
for (i = 0; i < n; ++i) {
|
for (i = 0; i < n; ++i)
|
||||||
|
{
|
||||||
dot_v3_u1 += v3[i] * u1[i];
|
dot_v3_u1 += v3[i] * u1[i];
|
||||||
dot_u1_u1 += u1[i] * u1[i];
|
dot_u1_u1 += u1[i] * u1[i];
|
||||||
}
|
}
|
||||||
for (i = 0; i < n; ++i) {
|
for (i = 0; i < n; ++i)
|
||||||
|
{
|
||||||
proj1[i] = u1[i] * (dot_v3_u1 / dot_u1_u1);
|
proj1[i] = u1[i] * (dot_v3_u1 / dot_u1_u1);
|
||||||
}
|
}
|
||||||
|
|
||||||
for (i = 0; i < n; ++i) {
|
for (i = 0; i < n; ++i)
|
||||||
|
{
|
||||||
dot_v3_u2 += v3[i] * u2[i];
|
dot_v3_u2 += v3[i] * u2[i];
|
||||||
dot_u2_u2 += u2[i] * u2[i];
|
dot_u2_u2 += u2[i] * u2[i];
|
||||||
}
|
}
|
||||||
for (i = 0; i < n; ++i) {
|
for (i = 0; i < n; ++i)
|
||||||
|
{
|
||||||
proj2[i] = u2[i] * (dot_v3_u2 / dot_u2_u2);
|
proj2[i] = u2[i] * (dot_v3_u2 / dot_u2_u2);
|
||||||
u3[i] = v3[i] - proj1[i] - proj2[i];
|
u3[i] = v3[i] - proj1[i] - proj2[i];
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
float magnitude = 0.0f;
|
float magnitude = 0.0f;
|
||||||
for (i = 0; i < n; ++i) {
|
for (i = 0; i < n; ++i)
|
||||||
|
{
|
||||||
magnitude += u3[i] * u3[i];
|
magnitude += u3[i] * u3[i];
|
||||||
}
|
}
|
||||||
magnitude = sqrtf(magnitude);
|
magnitude = sqrtf(magnitude);
|
||||||
|
|
||||||
for (i = 0; i < n; ++i) {
|
for (i = 0; i < n; ++i)
|
||||||
|
{
|
||||||
normal[i] = u3[i] / magnitude;
|
normal[i] = u3[i] / magnitude;
|
||||||
}
|
}
|
||||||
|
|
||||||
@@ -275,7 +285,6 @@ static void __calculate_normal(
|
|||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
float *generate_normals_surface(float *d, unsigned char m)
|
float *generate_normals_surface(float *d, unsigned char m)
|
||||||
{
|
{
|
||||||
float *n;
|
float *n;
|
||||||
@@ -288,7 +297,6 @@ float *generate_normals_surface(float *d, unsigned char m)
|
|||||||
for (int i = 0; i < *d; i += 3 * m)
|
for (int i = 0; i < *d; i += 3 * m)
|
||||||
{
|
{
|
||||||
|
|
||||||
|
|
||||||
__calculate_normal(
|
__calculate_normal(
|
||||||
(d + 1) + i, (d + 1) + i + m, (d + 1) + i + 2 * m, norm_vec, m);
|
(d + 1) + i, (d + 1) + i + m, (d + 1) + i + 2 * m, norm_vec, m);
|
||||||
glm_vec3_copy(norm_vec, (n + 1) + i);
|
glm_vec3_copy(norm_vec, (n + 1) + i);
|
||||||
|
|||||||
Reference in New Issue
Block a user