falso
/
papermario
mirror of https://github.com/pmret/papermario.git
1
0
Fork 0
Code Issues Packages Projects Releases Wiki Activity
papermario/src/camera.c

495 lines
17 KiB
C
Raw Blame History

#include "common.h"
#include "camera.h"
s32 gCurrentCameraID = CAM_DEFAULT;
CameraControlSettings* test_ray_zone(f32 posX, f32 posY, f32 posZ, Collider** zone) {
f32 hitX, hitY, hitZ, hitDepth, nX, nY, nZ;
s32 zoneID;
hitDepth = 32767.0f;
zoneID = test_ray_zones(posX, posY, posZ, 0.0f, -1.0f, 0.0f, &hitX, &hitY, &hitZ, &hitDepth, &nX, &nY, &nZ);
if (zoneID >= 0) {
if (zone != NULL) {
*zone = &gZoneCollisionData.colliderList[zoneID];
}
return gZoneCollisionData.colliderList[zoneID].camSettings;
} else {
return NULL;
}
}
s32 calculate_segment_intersection(f32 A1x, f32 A1z, f32 A2x, f32 A2z, f32 B1x, f32 B1z, f32 B2x, f32 B2z, f32* interX, f32* interZ, f32* squared_dist) {
f32 dx14;
f32 dx13;
f32 dz;
f32 dz12;
f32 dx34;
f32 dx12;
f32 dx;
f32 alpha;
f32 minus_dz12;
f32 B2_side;
f32 x;
f32 B1_side;
f32 z;
f32 dx12_copy;
f32 dz13;
f32 dz14;
f32 dz34;
f32 B1_side_;
dx12_copy = A2x - A1x;
dx12 = dx12_copy;
dz12 = A2z - A1z;
dx13 = B1x - A1x;
dz13 = B1z - A1z;
dx14 = B2x - A1x;
dz14 = B2z - A1z;
minus_dz12 = -dz12;
dx34 = B2x - B1x;
dz34 = B2z - B1z;
// if distance between points on the line is 0
if (dx12_copy == 0.0f && dz12 == 0.0f) {
return FALSE;
}
// if length of second segment is 0
if (dx34 == 0.0f && dz34 == 0.0f) {
return FALSE;
}
B1_side_ = minus_dz12 * dx13 + dx12_copy * dz13;
if (B1_side_ < 0.0f) {
B1_side = -1.0f;
} else if (B1_side_ > 0.0f) {
B1_side = 1.0f;
} else {
B1_side = 0.0f;
}
B1_side_ = B1_side;
dx = minus_dz12 * dx14 + dx12_copy * dz14;
if (dx < 0.0f) {
B2_side = -1.0f;
} else if (dx > 0.0f) {
B2_side = 1.0f;
} else {
B2_side = 0.0f;
}
// B1 and B2 are on the same side relative to the line: no intersection
if (B1_side_ == B2_side) {
return FALSE;
}
if (fabsf(dx12) > fabsf(dx34)) {
/*
We represent intersection point P as P = B1 + alpha * (B2 - B1)
and solve the equation (P - A1) x (A2 - A1) = 0, where 'x' is cross product, A1 and A2 are points on the line
and B1 and B2 are the ends of the segment.
So, (B1 - A1 + alpha * (B2 - B1)) x (A2 - A1) = 0,
alpha = [-(B1 - A1) x (A2 - A1)] / [(B2 - B1) x (A2 - A1)]
*/
// same as -(B1 - A1) x (A2 - A1)
alpha = A1x * dz12 - A1z * dx12 + dx12 * B1z - dz12 * B1x;
// divide by (B2 - B1) x (A2 - A1)
alpha /= dz12 * dx34 - dx12 * dz34;
/*
Now we represent P as P = A1 + beta * (A2 - A1), and we are to find beta.
B1 + alpha * (B2 - B1) = A1 + beta * (A2 - A1)
beta * (A2 - A1) = B1 + alpha * (B2 - B1) - A1
We use only 'x' part of this equation to find beta.
Actually this step could be omitted and we calculate intersection directly as B1 + alpha * (B2 - B1).
Don't know why it's done this way.
*/
alpha = (B1x + dx34 * alpha - A1x) / dx12;
x = A1x + dx12 * alpha;
z = A1z + dz12 * alpha;
} else {
/*
We represent intersection point P as P = A1 + alpha * (A2 - A1)
and solve the equation (B2 - B1) x (P - B1) = 0
*/
// same as (B2 - B1) x (B1 - A1)
alpha = B1z * dx34 + A1x * dz34 - B1z * dz34 - A1z * dx34;
// divide by (B2 - B1) x (A2 - A1)
alpha /= dz12 * dx34 - dx12 * dz34;
// Now we represent P as P = B1 + beta * (B2 - B1) and find beta
alpha = (A1x + dx12 * alpha - B1x) / dx34;
x = B1x + dx34 * alpha;
z = B1z + dz34 * alpha;
}
// (P - A1) * (P - A2) > 0 when P is outside of segment A1-A2
if ((x - A1x) * (x - A2x) + (z - A1z) * (z - A2z) > 0.0f) {
return FALSE;
}
dx = x - B1x;
dz = z - B1z;
*interX = x;
*interZ = z;
// distance between P and B1
*squared_dist = SQ(dx) + SQ(dz);
return TRUE;
}
s32 calculate_line_segment_intersection(f32 A1x, f32 A1z, f32 A2x, f32 A2z, f32 B1x, f32 B1z, f32 B2x, f32 B2z, f32* interX, f32* interZ, f32* squared_dist) {
f32 dx14;
f32 dx13;
f32 dz;
f32 dz12;
f32 dx34;
f32 dx12;
f32 dx;
f32 alpha;
f32 minus_dz12;
f32 B2_side;
f32 x;
f32 B1_side;
f32 z;
f32 dx12_copy;
f32 dz13;
f32 dz14;
f32 dz34;
f32 B1_side_;
dx12_copy = A2x - A1x;
dx12 = dx12_copy;
dz12 = A2z - A1z;
dx13 = B1x - A1x;
dz13 = B1z - A1z;
dx14 = B2x - A1x;
dz14 = B2z - A1z;
minus_dz12 = -dz12;
dx34 = B2x - B1x;
dz34 = B2z - B1z;
if (dx12_copy == 0.0f && dz12 == 0.0f) {
return FALSE;
}
if (dx34 == 0.0f && dz34 == 0.0f) {
return FALSE;
}
B1_side_ = minus_dz12 * dx13 + dx12_copy * dz13;
if (B1_side_ < 0.0f) {
B1_side = -1.0f;
} else if (B1_side_ > 0.0f) {
B1_side = 1.0f;
} else {
B1_side = 0.0f;
}
B1_side_ = B1_side;
dx = minus_dz12 * dx14 + dx12_copy * dz14;
if (dx < 0.0f) {
B2_side = -1.0f;
} else if (dx > 0.0f) {
B2_side = 1.0f;
} else {
B2_side = 0.0f;
}
if (B1_side_ == B2_side) {
return FALSE;
}
if (fabsf(dx12) > fabsf(dx34)) {
alpha = A1x * dz12 - A1z * dx12 + dx12 * B1z - dz12 * B1x;
alpha /= dz12 * dx34 - dx12 * dz34;
alpha = (B1x + dx34 * alpha - A1x) / dx12;
x = A1x + dx12 * alpha;
z = A1z + dz12 * alpha;
} else {
alpha = B1z * dx34 + A1x * dz34 - B1z * dz34 - A1z * dx34;
alpha /= dz12 * dx34 - dx12 * dz34;
alpha = (A1x + dx12 * alpha - B1x) / dx34;
x = B1x + dx34 * alpha;
z = B1z + dz34 * alpha;
}
dx = x - B1x;
dz = z - B1z;
*interX = x;
*interZ = z;
*squared_dist = SQ(dx) + SQ(dz);
return TRUE;
}
s32 func_800328A4(CameraControlSettings* camSettings, f32 x, f32 z) {
f32 product1, product2;
f32 delta, p1, p2, p3, p4;
if (camSettings == NULL) {
return 0;
}
if (camSettings->type != CAM_CONTROL_CONSTAIN_BETWEEN_POINTS) {
return 0;
}
delta = x - camSettings->points.two.Ax;
p1 = (camSettings->points.two.Bx - camSettings->points.two.Ax) * delta;
delta = z - camSettings->points.two.Az;
p2 = (camSettings->points.two.Bz - camSettings->points.two.Az) * delta;
delta = x - camSettings->points.two.Bx;
p3 = (camSettings->points.two.Bx - camSettings->points.two.Ax) * delta;
delta = z - camSettings->points.two.Bz;
p4 = (camSettings->points.two.Bz - camSettings->points.two.Az) * delta;
product1 = p1 + p2;
product2 = p3 + p4;
if (product1 < 0 && product2 < 0) {
return -1;
}
if (product1 > 0 && product2 > 0) {
return 1;
}
return 0;
}
void func_80032970(Camera* camera, f32 arg1) {
f32 stickX;
f32 deltaLeadAmount;
s32 flags = camera->flags & CAMERA_FLAG_1000;
s32 a2 = flags != 0;
if (camera->currentController != NULL && camera->currentController->type == CAM_CONTROL_FIXED_POS_AND_ORIENTATION) {
a2 = TRUE;
}
if (a2) {
stickX = 0.0f;
camera->unk_51C = TRUE;
camera->unk_514 = 1.0f;
camera->unk_510 = 0.0f;
} else {
if (gPlayerStatusPtr->animFlags & PA_FLAG_RIDING_PARTNER) {
stickX = gPartnerStatus.stickX;
} else {
stickX = gPlayerStatusPtr->stickAxis[0];
}
if (stickX > 0.0f) {
stickX = 50.0f;
}
if (stickX < 0.0f) {
stickX = -50.0f;
}
}
if (stickX != 0.0f) {
if (stickX < 0.0f) {
if (camera->unk_518 > 0.0f) {
camera->unk_518 = stickX;
} else {
camera->unk_518 += stickX;
}
if (camera->unk_518 <= -300.0f) {
camera->unk_51C = TRUE;
if (camera->unk_510 > 0.0f) {
camera->unk_514 = 0.0f;
}
camera->unk_510 = -arg1;
camera->unk_518 = -300.0f;
}
} else {
if (camera->unk_518 < 0.0f) {
camera->unk_518 = stickX;
} else {
camera->unk_518 += stickX;
}
if (camera->unk_518 >= 300.0f) {
camera->unk_51C = TRUE;
if (camera->unk_510 < 0.0f) {
camera->unk_514 = 0.0f;
}
camera->unk_510 = arg1;
camera->unk_518 = 300.0f;
}
}
}
if (camera->unk_51C) {
camera->unk_514 += 0.01f;
if (camera->unk_514 > 1.0f) {
camera->unk_514 = 1.0f;
}
}
if (camera->unk_510 - camera->leadAmount == 0.0f) {
camera->unk_514 = 0.0f;
camera->unk_51C = FALSE;
}
deltaLeadAmount = (camera->unk_510 - camera->leadAmount) * camera->unk_514;
if (camera->unk_510 - camera->leadAmount > 0.0f) {
if (camera->unk_510 - camera->leadAmount < 0.1) {
deltaLeadAmount = camera->unk_510 - camera->leadAmount;
}
if (deltaLeadAmount > 3.0f) {
deltaLeadAmount = 3.0f;
}
} else {
if (camera->unk_510 - camera->leadAmount > -0.1) {
deltaLeadAmount = camera->unk_510 - camera->leadAmount;
}
if (deltaLeadAmount < -3.0f) {
deltaLeadAmount = -3.0f;
}
}
if (stickX != 0.0f || a2) {
camera->leadAmount += deltaLeadAmount;
} else {
camera->unk_514 = 0.0f;
}
}
void func_80032C64(Camera* camera) {
s32 i;
f32 rotationRad;
f32 leadAmount;
CameraControlSettings* settings;
CameraControlSettings* settings2;
CameraControlSettings* settings3;
s32 s2;
f32 X, Y, Z, W;
f32 product;
f32 newPosX, newPosZ;
Collider* zone;
s32 cond;
f32 dist;
f32 sp44, sp48, sp4C;
f32 deltaPosX, deltaPosZ;
f32 f24, f22, cosYaw, sinYaw;
rotationRad = camera->trueRotation.x / 180.0f * PI;
leadAmount = camera->leadAmount;
s2 = 0;
cos_rad(rotationRad);
sin_rad(rotationRad);
settings3 = settings = test_ray_zone(camera->targetPos.x, camera->targetPos.y + 10.0f, camera->targetPos.z, NULL);
if (settings != NULL) {
if (settings->type == CAM_CONTROL_CONSTRAIN_TO_LINE || settings->type == CAM_CONTROL_LOOK_AT_POINT_CONSTAIN_TO_LINE || (s2 = func_800328A4(settings, camera->targetPos.x, camera->targetPos.z))) {
if (camera->unk_530) {
guPerspectiveF(camera->perspectiveMatrix, &camera->perspNorm, camera->vfov,
(f32)camera->viewportW / (f32)camera->viewportH, camera->nearClip, camera->farClip, 1.0f);
guMtxCatF(camera->viewMtxPlayer, camera->perspectiveMatrix, camera->perspectiveMatrix);
transform_point(camera->perspectiveMatrix, camera->targetPos.x, camera->targetPos.y, camera->targetPos.z,
1.0f, &X, &Y, &Z, &W);
if (W == 0.0f) {
W = 1.0f;
}
W = 1.0f / W;
X *= W;
camera->unk_52C = (X > 0.0f) ? 1 : (X < 0.0f) ? -1 : 0;
camera->unk_530 = 0;
} else {
CameraControlSettings* aabbForZoneBelow = camera->aabbForZoneBelow;
if (!(aabbForZoneBelow != NULL && (aabbForZoneBelow->type == CAM_CONTROL_CONSTRAIN_TO_LINE || aabbForZoneBelow->type == CAM_CONTROL_LOOK_AT_POINT_CONSTAIN_TO_LINE || func_800328A4(settings, camera->unk_524, camera->unk_528) != 0))) {
if (aabbForZoneBelow != NULL && s2 != 0) {
camera->unk_52C = s2;
} else {
f24 = cosYaw = camera->targetPos.x - camera->unk_524;
f22 = camera->targetPos.z - camera->unk_528;
cosYaw = -cos_deg(camera->currentYaw);
sinYaw = -sin_deg(camera->currentYaw);
product = f24 * cosYaw + f22 * sinYaw;
camera->unk_52C = (product > 0) ? -1 : (product < 0) ? 1 : 0;
}
}
}
if (leadAmount > 0.0f && camera->unk_52C > 0 || leadAmount < 0.0f && camera->unk_52C < 0) {
camera->unk_514 = 0.0f;
camera->leadAmount = 0.0f;
}
camera->aabbForZoneBelow = settings3;
camera->unk_524 = camera->targetPos.x;
camera->unk_528 = camera->targetPos.z;
return;
}
}
camera->unk_52C = 0;
camera->aabbForZoneBelow = settings3;
camera->unk_524 = camera->targetPos.x;
camera->unk_528 = camera->targetPos.z;
newPosX = camera->targetPos.x + leadAmount * cos_rad(rotationRad);
newPosZ = camera->targetPos.z + leadAmount * sin_rad(rotationRad);
settings = test_ray_zone(newPosX, camera->targetPos.y + 10.0f, newPosZ, &zone);
if (settings != NULL) {
if (settings->type == CAM_CONTROL_CONSTRAIN_TO_LINE || settings->type == CAM_CONTROL_LOOK_AT_POINT_CONSTAIN_TO_LINE || func_800328A4(camera->aabbForZoneBelow, newPosX, newPosZ) != 0) {
cond = TRUE;
dist = SQ(1000.0f);
if (camera->aabbForZoneBelow != NULL && camera->aabbForZoneBelow->type == CAM_CONTROL_CONSTAIN_BETWEEN_POINTS) {
settings2 = camera->aabbForZoneBelow;
cond = FALSE;
deltaPosX = settings2->points.two.Bx - settings2->points.two.Ax;
deltaPosZ = settings2->points.two.Bz - settings2->points.two.Az;
if (calculate_line_segment_intersection(settings2->points.two.Ax, settings2->points.two.Az, settings2->points.two.Ax - deltaPosZ, settings2->points.two.Az + deltaPosX,
camera->targetPos.x, camera->targetPos.z, newPosX, newPosZ, &sp44, &sp48, &sp4C) && sp4C < SQ(1000.0f)) {
dist = sp4C;
}
do {
if (calculate_line_segment_intersection(settings2->points.two.Bx, settings2->points.two.Bz, settings2->points.two.Bx - deltaPosZ, settings2->points.two.Bz + deltaPosX,
camera->targetPos.x, camera->targetPos.z, newPosX, newPosZ, &sp44, &sp48, &sp4C) && sp4C < dist) {
dist = sp4C;
}
} while (0); // TODO find better match
}
if (cond) {
for (i = 0; i < zone->numTriangles; i++) {
if (calculate_segment_intersection(zone->triangleTable[i].v1->x, zone->triangleTable[i].v1->z,
zone->triangleTable[i].v2->x, zone->triangleTable[i].v2->z,
camera->targetPos.x, camera->targetPos.z, newPosX, newPosZ, &sp44, &sp48, &sp4C) && sp4C < dist) {
dist = sp4C;
}
if (calculate_segment_intersection(zone->triangleTable[i].v2->x, zone->triangleTable[i].v2->z,
zone->triangleTable[i].v3->x, zone->triangleTable[i].v3->z,
camera->targetPos.x, camera->targetPos.z, newPosX, newPosZ, &sp44, &sp48, &sp4C) && sp4C < dist) {
dist = sp4C;
}
if (calculate_segment_intersection(zone->triangleTable[i].v3->x, zone->triangleTable[i].v3->z,
zone->triangleTable[i].v1->x, zone->triangleTable[i].v1->z,
camera->targetPos.x, camera->targetPos.z, newPosX, newPosZ, &sp44, &sp48, &sp4C) && sp4C < dist) {
dist = sp4C;
}
}
}
if (dist == SQ(1000.0f) || dist == 0) {
camera->leadAmount = 0.0f;
} else {
camera->leadAmount = (camera->leadAmount > 0.0f) ? sqrtf(dist) : -sqrtf(dist);
}
camera->unk_514 = 0.0f;
}
}
}
void create_camera_leadplayer_matrix(Camera* camera) {
f32 xTemp = camera->lookAt_eye.x - camera->lookAt_obj.x;
f32 yTemp = camera->lookAt_eye.y - camera->lookAt_obj.y;
f32 zTemp = camera->lookAt_eye.z - camera->lookAt_obj.z;
f32 dist = sqrtf(SQ(xTemp) + SQ(yTemp) + SQ(zTemp));
f32 theta = ((camera->vfov * 0.5f) / 180.0f) * PI;
f32 distSinTheta = dist * sin_rad(theta);
func_80032970(camera, (((distSinTheta / cos_rad(theta)) * camera->viewportW) / camera->viewportH) * camera->unk_520);
func_80032C64(camera);
guTranslateF(camera->viewMtxLeading, -camera->leadAmount, 0.0f, 0.0f);
}
void func_800334E8(void) {
}
Reference in New Issue View Git Blame Copy Permalink