REDRIVER2/src_rebuild/GAME/C/HANDLING.C

#include "THISDUST.H"
#include "HANDLING.H"
#include "COSMETIC.H"
#include "MISSION.H"
#include "DR2ROADS.H"
#include "TEXTURE.H"
#include "CARS.H"
#include "MAIN.H"
#include "WHEELFORCES.H"
#include "OBJCOLL.H"
#include "DENTING.H"
#include "CAMERA.H"
#include "FELONY.H"
#include "MISSION.H"
#include "DEBRIS.H"
#include "PAD.H"
#include "COP_AI.H"
#include "BCOLLIDE.H"
#include "BCOLL3D.H"

#include "GTEREG.H"
#include "INLINE_C.H"
#include "STRINGS.H"


// decompiled code
// original method signature: 
// void /*$ra*/ InitCarPhysics(struct _CAR_DATA *cp /*$s0*/, long (*startpos)[4] /*$t0*/, int direction /*$a2*/)
 // line 998, offset 0x0005381c
	/* begin block 1 */
		// Start line: 999
		// Start offset: 0x0005381C
		// Variables:
	// 		int ty; // $v1
	// 		int dz; // $s1
	// 		int odz; // $a3

		/* begin block 1.1 */
			// Start line: 1004
			// Start offset: 0x00053890
			// Variables:
		// 		unsigned long *dst; // $a1
		/* end block 1.1 */
		// End offset: 0x00053890
		// End Line: 1004
	/* end block 1 */
	// End offset: 0x000539E8
	// End Line: 1040

	/* begin block 2 */
		// Start line: 1996
	/* end block 2 */
	// End Line: 1997

	/* begin block 3 */
		// Start line: 2000
	/* end block 3 */
	// End Line: 2001

#include "CONVERT.H"

// [D]
void InitCarPhysics(_CAR_DATA *cp, long(*startpos)[4], int direction)
{
	char cVar1;
	int iVar2;
	char cVar3;
	uint uVar4;
	int iVar5;

	uVar4 = cp->ap.model;
	iVar5 = (int)car_cosmetics[uVar4].wheelDisp[0].vz + (int)car_cosmetics[uVar4].wheelDisp[1].vz;
	iVar2 = iVar5 / 5;
	if (iVar5 < 0) {
		iVar5 = iVar5 + 0x1f;
	}
	cp->hd.direction = direction;

	cp->hd.autoBrake = '\0';

	cp->st.n.orientation[0] = -(int)rcossin_tbl[(direction & 0xffeU) + 1] * iVar2 + 0x800 >> 0xc;
	cp->st.n.orientation[1] = (int)rcossin_tbl[direction & 0xffeU];
	cp->st.n.orientation[2] = rcossin_tbl[direction & 0xffeU] * iVar2 + 0x800 >> 0xc;
	cp->st.n.orientation[3] = (int)rcossin_tbl[(direction & 0xffeU) + 1];
	cp->st.n.fposition[0] = (*startpos)[0] << 4;
	cp->st.n.fposition[1] = (*startpos)[1] << 4;

	iVar2 = (*startpos)[2];

	cp->st.n.linearVelocity[0] = 0;
	cp->st.n.linearVelocity[1] = 0;
	cp->st.n.linearVelocity[2] = 0;
	cp->st.n.angularVelocity[0] = 0;
	cp->st.n.angularVelocity[1] = 0;
	cp->st.n.angularVelocity[2] = 0;

	cp->hd.aacc[0] = 0;
	cp->hd.aacc[1] = 0;
	cp->hd.aacc[2] = 0;
	cp->hd.acc[0] = 0;
	cp->hd.acc[1] = 0;
	cp->hd.acc[2] = 0;

	cp->st.n.fposition[2] = iVar2 << 4;

	RebuildCarMatrix(&cp->st, cp);
	
	cp->hd.drawCarMat.m[0][0] = -cp->hd.where.m[0][0];
	cp->hd.drawCarMat.m[0][1] = cp->hd.where.m[0][1];
	cp->hd.drawCarMat.m[0][2] = -cp->hd.where.m[0][2];

	cp->hd.drawCarMat.m[1][0] = -cp->hd.where.m[1][0];
	cp->hd.drawCarMat.m[1][1] = cp->hd.where.m[1][1];
	cp->hd.drawCarMat.m[1][2] = -cp->hd.where.m[1][2];

	cp->hd.drawCarMat.m[2][0] = -cp->hd.where.m[2][0];
	cp->hd.drawCarMat.m[2][1] = cp->hd.where.m[2][1];
	cp->hd.drawCarMat.m[2][2] = -cp->hd.where.m[2][2];

	cVar3 = (char)(iVar5 >> 5);
	cVar1 = 14 - cVar3;
	
	cVar3 = cVar3 + 14;

	
	
	cp->hd.wheel[0].susCompression = cVar1;
	cp->hd.wheel[1].susCompression = cVar3;
	cp->hd.wheel[2].susCompression = cVar1;
	cp->hd.wheel[3].susCompression = cVar3;
	
	cp->thrust = 0;
	cp->wheel_angle = 0;
	cp->hd.wheel_speed = 0;
}



// decompiled code
// original method signature: 
// void /*$ra*/ TempBuildHandlingMatrix(struct _CAR_DATA *cp /*$s0*/, int init /*$a1*/)
 // line 1055, offset 0x000539e8
	/* begin block 1 */
		// Start line: 1056
		// Start offset: 0x000539E8
		// Variables:
	// 		int ty; // $v1
	// 		int dz; // $a3
	/* end block 1 */
	// End offset: 0x00053B08
	// End Line: 1075

	/* begin block 2 */
		// Start line: 2158
	/* end block 2 */
	// End Line: 2159

	/* begin block 3 */
		// Start line: 2174
	/* end block 3 */
	// End Line: 2175

	/* begin block 4 */
		// Start line: 2178
	/* end block 4 */
	// End Line: 2179

void TempBuildHandlingMatrix(_CAR_DATA *cp, int init)
{
	UNIMPLEMENTED();
	/*
	int iVar1;
	int iVar2;
	uint uVar3;
	int iVar4;

	uVar3 = (uint)(byte)(cp->ap).model;
	iVar1 = ((int)car_cosmetics[uVar3].wheelDisp[0].vz + (int)car_cosmetics[uVar3].wheelDisp[1].vz) /
		5;
	if (init == 1) {
		iVar4 = (cp->hd).where.t[1];
		*(long *)cp->st = (cp->hd).where.t[0] << 4;
		iVar2 = (cp->hd).where.t[2];
		*(int *)(cp->st + 4) = iVar4 << 4;
		*(int *)(cp->st + 8) = iVar2 << 4;
	}
	uVar3 = (cp->hd).direction & 0xffe;
	*(int *)(cp->st + 0xc) = -(int)rcossin_tbl[uVar3 + 1] * iVar1 + 0x800 >> 0xc;
	*(int *)(cp->st + 0x10) = (int)rcossin_tbl[uVar3];
	*(int *)(cp->st + 0x14) = rcossin_tbl[uVar3] * iVar1 + 0x800 >> 0xc;
	*(int *)(cp->st + 0x18) = (int)rcossin_tbl[uVar3 + 1];
	RebuildCarMatrix((RigidBodyState *)cp->st, cp);
	SetShadowPoints(cp);
	return;*/
}



// decompiled code
// original method signature: 
// void /*$ra*/ UpdateCarPoints(struct CAR_COSMETICS *carCos /*$a0*/)
 // line 1079, offset 0x00053b08
	/* begin block 1 */
		// Start line: 1080
		// Start offset: 0x00053B08
		// Variables:
	// 		struct SVECTOR *groundCollPoints; // $a1
	// 		struct SVECTOR *wheelPoints; // $a3
	// 		int i; // $a2
	/* end block 1 */
	// End offset: 0x00053C00
	// End Line: 1103

	/* begin block 2 */
		// Start line: 2233
	/* end block 2 */
	// End Line: 2234

	/* begin block 3 */
		// Start line: 2238
	/* end block 3 */
	// End Line: 2239

	/* begin block 4 */
		// Start line: 2239
	/* end block 4 */
	// End Line: 2240

SVECTOR delta = { 0 };
int doWheels = 1;

// [D]
void UpdateCarPoints(CAR_COSMETICS *carCos)
{
	SVECTOR *groundCollPoints;
	SVECTOR *wheelPoints;
	int i;

	groundCollPoints = carCos->cPoints;
	wheelPoints = carCos->wheelDisp;

	i = 11;

	do {
		groundCollPoints->vx = groundCollPoints->vx + delta.vx;
		groundCollPoints->vy = groundCollPoints->vy - delta.vy;
		groundCollPoints->vz = groundCollPoints->vz + delta.vz;
		groundCollPoints++;
		i--;
	} while (-1 < i);

	if (doWheels != 0) 
	{
		i = 3;

		do {
			wheelPoints->vx = wheelPoints->vx + delta.vx;
			wheelPoints->vy = wheelPoints->vy - delta.vy;
			wheelPoints->vz = wheelPoints->vz + delta.vz;
			wheelPoints++;
			i--;
		} while (-1 < i);
	}

	carCos->cog.vx = carCos->cog.vx + delta.vx;
	carCos->cog.vy = carCos->cog.vy + delta.vy;
	carCos->cog.vz = carCos->cog.vz - delta.vz;

	delta.vx = 0;
	delta.vy = 0;
	delta.vz = 0;
}



// decompiled code
// original method signature: 
// void /*$ra*/ FixCarCos(struct CAR_COSMETICS *carCos /*$s0*/, int externalModelNumber /*$a1*/)
 // line 1106, offset 0x00056c24
	/* begin block 1 */
		// Start line: 1107
		// Start offset: 0x00056C24
		// Variables:
	// 		int current; // $v0
	/* end block 1 */
	// End offset: 0x00056CB8
	// End Line: 1130

	/* begin block 2 */
		// Start line: 5974
	/* end block 2 */
	// End Line: 5975

	/* begin block 3 */
		// Start line: 2212
	/* end block 3 */
	// End Line: 2213

	/* begin block 4 */
		// Start line: 5977
	/* end block 4 */
	// End Line: 5978

// [D]
void FixCarCos(CAR_COSMETICS *carCos, int externalModelNumber)
{
	delta.vx = 0;
	delta.vy = 0;

	doWheels = 1;
	delta.vz = -(short)(((int)carCos->wheelDisp[0].vz + (int)carCos->wheelDisp[1].vz + -0xe) / 2);

	UpdateCarPoints(carCos);

	if ((carCos == car_cosmetics + 2) && (gCurrentMissionNumber == 7)) {
		car_cosmetics[2].mass = car_cosmetics[2].mass * 3;
	}
}



// decompiled code
// original method signature: 
// void /*$ra*/ GlobalTimeStep()
 // line 1192, offset 0x00053c00
	/* begin block 1 */
		// Start line: 1194
		// Start offset: 0x00053C00
		// Variables:
	// 		int i; // $fp
	// 		int RKstep; // stack offset -84
	// 		int subframe; // stack offset -80
	// 		struct _CAR_DATA *c0; // $s0
	// 		static union RigidBodyState _tp[20]; // offset 0x0
	// 		static union RigidBodyState _d0[20]; // offset 0x410
	// 		static union RigidBodyState _d1[20]; // offset 0x820

		/* begin block 1.1 */
			// Start line: 1268
			// Start offset: 0x00053C6C
			// Variables:
		// 		struct _CAR_DATA *c0; // $t2
		// 		union RigidBodyState *st; // $t1

			/* begin block 1.1.1 */
				// Start line: 1283
				// Start offset: 0x00053D2C
				// Variables:
			// 		int s; // $v0
			/* end block 1.1.1 */
			// End offset: 0x00053D90
			// End Line: 1293

			/* begin block 1.1.2 */
				// Start line: 1301
				// Start offset: 0x00053E18
				// Variables:
			// 		long AV[4]; // stack offset -248
			// 		long delta_orientation[4]; // stack offset -232
			/* end block 1.1.2 */
			// End offset: 0x00053FF8
			// End Line: 1321
		/* end block 1.1 */
		// End offset: 0x00053FF8
		// End Line: 1322

		/* begin block 1.2 */
			// Start line: 1334
			// Start offset: 0x00054024
			// Variables:
		// 		union RigidBodyState *thisDelta; // stack offset -76

			/* begin block 1.2.1 */
				// Start line: 1340
				// Start offset: 0x00054038
				// Variables:
			// 		struct _CAR_DATA *c0; // $s4

				/* begin block 1.2.1.1 */
					// Start line: 1348
					// Start offset: 0x00054094
					// Variables:
				// 		union RigidBodyState *thisState_i; // $s6
				// 		int j; // stack offset -72

					/* begin block 1.2.1.1.1 */
						// Start line: 1193
						// Start offset: 0x000540EC
						// Variables:
					// 		union RigidBodyState *state; // $s6
					// 		union RigidBodyState *delta; // $a3
					// 		struct _CAR_DATA *cp; // $s4

						/* begin block 1.2.1.1.1.1 */
							// Start line: 1193
							// Start offset: 0x000540EC
							// Variables:
						// 		long AV[4]; // stack offset -248
						/* end block 1.2.1.1.1.1 */
						// End offset: 0x000540EC
						// End Line: 1193
					/* end block 1.2.1.1.1 */
					// End offset: 0x000540EC
					// End Line: 1193

					/* begin block 1.2.1.1.2 */
						// Start line: 1367
						// Start offset: 0x000542D8
						// Variables:
					// 		struct _CAR_DATA *c1; // $s3
					// 		union RigidBodyState *thisState_j; // $s0

						/* begin block 1.2.1.1.2.1 */
							// Start line: 1375
							// Start offset: 0x00054340
							// Variables:
						// 		int strength; // $s5
						// 		long centre0[4]; // stack offset -248
						// 		long centre1[4]; // stack offset -232
						// 		long normal[4]; // stack offset -216
						// 		long collisionpoint[4]; // stack offset -200

							/* begin block 1.2.1.1.2.1.1 */
								// Start line: 1378
								// Start offset: 0x00054340
								// Variables:
							// 		struct BOUND_BOX *bb1; // $a2
							// 		struct BOUND_BOX *bb2; // $a0
							/* end block 1.2.1.1.2.1.1 */
							// End offset: 0x00054440
							// End Line: 1409

							/* begin block 1.2.1.1.2.1.2 */
								// Start line: 1414
								// Start offset: 0x00054440
								// Variables:
							// 		int depth; // stack offset -88
							/* end block 1.2.1.1.2.1.2 */
							// End offset: 0x00054460
							// End Line: 1419

							/* begin block 1.2.1.1.2.1.3 */
								// Start line: 1419
								// Start offset: 0x00054460
								// Variables:
							// 		long lever0[4]; // stack offset -184
							// 		long lever1[4]; // stack offset -168
							// 		long torque[4]; // stack offset -152
							// 		long pointVel0[4]; // stack offset -136
							// 		long pointVel1[4]; // stack offset -120
							// 		int strikeVel; // stack offset -68

								/* begin block 1.2.1.1.2.1.3.1 */
									// Start line: 1419
									// Start offset: 0x00054460
									// Variables:
								// 		int is; // $v0
								// 		int wanted; // $v1
								/* end block 1.2.1.1.2.1.3.1 */
								// End offset: 0x00054460
								// End Line: 1419

								/* begin block 1.2.1.1.2.1.3.2 */
									// Start line: 1487
									// Start offset: 0x00054870
									// Variables:
								// 		struct VECTOR velocity; // stack offset -104

									/* begin block 1.2.1.1.2.1.3.2.1 */
										// Start line: 1506
										// Start offset: 0x00054924
										// Variables:
									// 		int debris1; // $s0
									// 		int debris2; // $s2
									/* end block 1.2.1.1.2.1.3.2.1 */
									// End offset: 0x0005497C
									// End Line: 1518
								/* end block 1.2.1.1.2.1.3.2 */
								// End offset: 0x0005497C
								// End Line: 1519

								/* begin block 1.2.1.1.2.1.3.3 */
									// Start line: 1526
									// Start offset: 0x000549BC
									// Variables:
								// 		int do1; // $a0
								// 		int do2; // $t5
								// 		int m1; // $t3
								// 		int m2; // $a1

									/* begin block 1.2.1.1.2.1.3.3.1 */
										// Start line: 1548
										// Start offset: 0x00054A50
										// Variables:
									// 		long force[4]; // stack offset -104
									// 		int strength1; // $a0
									// 		int twistY; // $t4
									/* end block 1.2.1.1.2.1.3.3.1 */
									// End offset: 0x00054CA0
									// End Line: 1577

									/* begin block 1.2.1.1.2.1.3.3.2 */
										// Start line: 1581
										// Start offset: 0x00054CA8
										// Variables:
									// 		long force[4]; // stack offset -104
									// 		int strength2; // $a1
									// 		int twistY; // $t2
									/* end block 1.2.1.1.2.1.3.3.2 */
									// End offset: 0x00054EDC
									// End Line: 1610
								/* end block 1.2.1.1.2.1.3.3 */
								// End offset: 0x00054EDC
								// End Line: 1611
							/* end block 1.2.1.1.2.1.3 */
							// End offset: 0x00054F58
							// End Line: 1618
						/* end block 1.2.1.1.2.1 */
						// End offset: 0x00054F58
						// End Line: 1619
					/* end block 1.2.1.1.2 */
					// End offset: 0x00054F58
					// End Line: 1620
				/* end block 1.2.1.1 */
				// End offset: 0x00054F7C
				// End Line: 1621
			/* end block 1.2.1 */
			// End offset: 0x00054F7C
			// End Line: 1622

			/* begin block 1.2.2 */
				// Start line: 1626
				// Start offset: 0x00054FA4
				// Variables:
			// 		struct _CAR_DATA *c0; // $a1

				/* begin block 1.2.2.1 */
					// Start line: 1630
					// Start offset: 0x00054FC4
					// Variables:
				// 		union RigidBodyState *st; // $t2
				// 		union RigidBodyState *tp; // $a0
				// 		union RigidBodyState *d0; // $a2
				// 		union RigidBodyState *d1; // $v1
				// 		int j; // $t1
				/* end block 1.2.2.1 */
				// End offset: 0x000550B0
				// End Line: 1646
			/* end block 1.2.2 */
			// End offset: 0x000550B0
			// End Line: 1647
		/* end block 1.2 */
		// End offset: 0x000550C8
		// End Line: 1648

		/* begin block 1.3 */
			// Start line: 1652
			// Start offset: 0x000550F4
			// Variables:
		// 		int carsDentedThisFrame; // $s2

			/* begin block 1.3.1 */
				// Start line: 1655
				// Start offset: 0x00055104

				/* begin block 1.3.1.1 */
					// Start line: 1656
					// Start offset: 0x00055104
					// Variables:
				// 		unsigned long *dst; // $a1
				/* end block 1.3.1.1 */
				// End offset: 0x00055104
				// End Line: 1656

				/* begin block 1.3.1.2 */
					// Start line: 1670
					// Start offset: 0x00055188
				/* end block 1.3.1.2 */
				// End offset: 0x00055198
				// End Line: 1673
			/* end block 1.3.1 */
			// End offset: 0x00055198
			// End Line: 1675
		/* end block 1.3 */
		// End offset: 0x000551EC
		// End Line: 1679
	/* end block 1 */
	// End offset: 0x000551EC
	// End Line: 1699

	/* begin block 2 */
		// Start line: 2396
	/* end block 2 */
	// End Line: 2397

	/* begin block 3 */
		// Start line: 2486
	/* end block 3 */
	// End Line: 2487

	/* begin block 4 */
		// Start line: 2487
	/* end block 4 */
	// End Line: 2488

	/* begin block 5 */
		// Start line: 2530
	/* end block 5 */
	// End Line: 2531

/* WARNING: Unknown calling convention yet parameter storage is locked */

int playerghost = 0;
int playerhitcopsanyway = 0;

// [D]
void GlobalTimeStep(void)
{
	static union RigidBodyState _tp[20]; // offset 0x0
	static union RigidBodyState _d0[20]; // offset 0x410
	static union RigidBodyState _d1[20]; // offset 0x820

	unsigned char uVar1;
	unsigned char uVar2;
	short sVar3;
	bool bVar4;
	int iVar5;
	uint uVar6;
	long lVar7;
	long lVar8;
	int howHard;
	int iVar9;
	long lVar10;
	int iVar11;
	int iVar12;
	int iVar13;
	uint uVar14;
	int iVar15;
	int iVar16;
	long *plVar17;
	long *piVar18;
	int iVar19;
	int iVar20;
	int iVar21;
	int iVar22;
	long *plVar23;
	int iVar24;
	_CAR_DATA *cp;
	RigidBodyState *p_Var25;
	_CAR_DATA **pp_Var26;
	_CAR_DATA *c1;
	RigidBodyState *st;
	RigidBodyState *p_Var27;
	int iVar28;
	long AV[4];
	long delta_orientation[4];
	long normal[4];
	long collisionpoint[4];
	long lever0[4];
	long lever1[4];
	long torque[4];
	long pointVel0[4];
	long pointVel1[4];
	VECTOR velocity;
	int local_58;
	int RKstep;
	int subframe;
	RigidBodyState *local_4c;
	int local_48;
	int local_40;
	int local_34;
	int local_30;

	StepCars();
	CheckCarToCarCollisions();

	if ((playerghost != 0) && (playerhitcopsanyway == 0)) 
		car_data[0].hd.mayBeColliding = '\0';

	iVar28 = 0;

	if (0 < num_active_cars) 
	{
		do {
			cp = active_car_list[iVar28];

			iVar19 = cp->hd.aacc[0];
			iVar21 = cp->hd.aacc[1];
			iVar24 = cp->hd.aacc[2];

			iVar5 = cp->st.n.linearVelocity[0];
			howHard = cp->hd.acc[0];
			iVar15 = cp->st.n.linearVelocity[1];
			iVar9 = cp->hd.acc[1];

			cp->hd.aacc[0] = 0;
			cp->hd.aacc[1] = 0;
			cp->hd.aacc[2] = 0;

			iVar15 = iVar15 + iVar9;
			(cp->st).n.linearVelocity[0] = iVar5 + howHard;
			iVar5 = cp->st.n.linearVelocity[2];
			iVar9 = cp->hd.acc[2];
			howHard = cp->st.n.angularVelocity[0];
			cp->st.n.linearVelocity[1] = iVar15;
			cp->st.n.linearVelocity[2] = iVar5 + iVar9;
			iVar5 = (cp->st).n.angularVelocity[1];
			cp->st.n.angularVelocity[0] = howHard + iVar19;
			howHard = (cp->st).n.angularVelocity[2];
			st = &cp->st;
			cp->st.n.angularVelocity[1] = iVar5 + iVar21;
			cp->st.n.angularVelocity[2] = howHard + iVar24;

			if (200000 < iVar15) 
			{
				iVar15 = iVar15 * 3;
				if (iVar15 < 0)
					iVar15 = iVar15 + 3;

				cp->st.n.linearVelocity[1] = iVar15 >> 2;
			}
			if (cp->hd.speed == 0)
			{
				iVar15 = cp->st.n.linearVelocity[0];
				iVar5 = cp->st.n.linearVelocity[1];
				howHard = cp->st.n.linearVelocity[2];

				if (iVar15 < 0) 
					iVar15 = -iVar15;

				if (iVar5 < 0) 
					iVar5 = -iVar5;

				if (howHard < 0) 
					howHard = -howHard;

				if (iVar15 + iVar5 + howHard < 1000) 
				{
					cp->st.n.linearVelocity[0] = 0;
					cp->st.n.linearVelocity[1] = 0;
					cp->st.n.linearVelocity[2] = 0;
					cp->st.n.angularVelocity[0] = 0;
					cp->st.n.angularVelocity[1] = 0;
					cp->st.n.angularVelocity[2] = 0;
				}
				else
				{
					cp->hd.speed = 1;
				}
			}
			iVar15 = cp->st.n.angularVelocity[0];
			lVar10 = 0x800000;

			if ((0x800000 < iVar15) || (lVar10 = -0x800000, iVar15 < -0x800000)) 
				cp->st.n.angularVelocity[0] = lVar10;

			iVar15 = cp->st.n.angularVelocity[1];
			lVar10 = 0x800000;

			if ((0x800000 < iVar15) || (lVar10 = -0x800000, iVar15 < -0x800000)) 
				cp->st.n.angularVelocity[1] = lVar10;

			iVar15 = cp->st.n.angularVelocity[2];
			lVar10 = 0x800000;

			if ((0x800000 < iVar15) || (lVar10 = -0x800000, iVar15 < -0x800000))
				cp->st.n.angularVelocity[2] = lVar10;

			if (cp->hd.mayBeColliding == 0)
			{
				iVar5 = cp->st.n.linearVelocity[1];
				iVar22 = cp->st.n.angularVelocity[0] + 0x1000 >> 0xd;

				st->n.fposition[0] = st->n.fposition[0] + (cp->st.n.linearVelocity[0] >> 8);
				iVar15 = cp->st.n.linearVelocity[2];

				cp->st.n.fposition[1] = (cp->st).n.fposition[1] + (iVar5 >> 8);
				cp->st.n.fposition[2] = (cp->st).n.fposition[2] + (iVar15 >> 8);

				iVar20 = cp->st.n.angularVelocity[1] + 0x1000 >> 0xd;
				iVar16 = cp->st.n.angularVelocity[2] + 0x1000 >> 0xd;

				iVar9 = cp->st.n.orientation[0];
				iVar11 = cp->st.n.orientation[2];
				iVar15 = cp->st.n.orientation[3];
				iVar5 = cp->st.n.orientation[0];
				iVar12 = cp->st.n.orientation[1];
				iVar19 = cp->st.n.orientation[3];
				iVar21 = cp->st.n.orientation[0];
				iVar13 = cp->st.n.orientation[1];
				howHard = cp->st.n.orientation[2];
				iVar24 = cp->st.n.orientation[1];

				cp->st.n.orientation[0] = cp->st.n.orientation[0] + (-cp->st.n.orientation[1] * iVar16 + cp->st.n.orientation[2] * iVar20 + cp->st.n.orientation[3] * iVar22 + 0x800 >> 0xc);
				cp->st.n.orientation[1] = iVar24 + ((iVar9 * iVar16 - iVar11 * iVar22) + iVar15 * iVar20 + 0x800 >> 0xc);

				iVar15 = cp->st.n.orientation[3];

				cp->st.n.orientation[2] = cp->st.n.orientation[2] + (-iVar5 * iVar20 + iVar12 * iVar22 + iVar19 * iVar16 + 0x800 >> 0xc);
				cp->st.n.orientation[3] = iVar15 + (((-iVar21 * iVar22 - iVar13 * iVar20) - howHard * iVar16) + 0x800 >> 0xc);

				RebuildCarMatrix((RigidBodyState *)st, cp);
			}
			iVar28 = iVar28 + 1;
		} while (iVar28 < num_active_cars);
	}
	subframe = 0;
	iVar28 = num_active_cars;
	do {

		RKstep = 0;
		iVar15 = subframe + 1;

		do {
			local_40 = 0;
			iVar5 = RKstep + 1;

			if (0 < iVar28)
			{
				howHard = 0;
				do {
					cp = *(_CAR_DATA **)((int)active_car_list + howHard);

					if (((RKstep != 0) && ((subframe & 1U) != 0)) && (cp->controlType == '\x01')) 
					{
						CheckScenaryCollisions(cp);
					}

					if (cp->hd.mayBeColliding != '\0')
					{
						local_34 = local_40 * 2;

						if (RKstep == 0) 
						{
							st = &cp->st;
							local_34 = local_40 << 1;
							local_4c = _d0;
						}
						else {
							st = _tp + local_40;
							local_4c = _d1;
						}
						piVar18 = local_4c->n.fposition + local_40 * 5 + local_34 * 4;

						*piVar18 = st->n.linearVelocity[0] >> 8;
						piVar18[1] = st->n.linearVelocity[1] >> 8;
						piVar18[2] = st->n.linearVelocity[2] >> 8;

						iVar9 = st->n.angularVelocity[0] + 0x1000 >> 0xd;
						howHard = st->n.angularVelocity[1] + 0x1000 >> 0xd;
						iVar28 = st->n.angularVelocity[2] + 0x1000 >> 0xd;

						piVar18[3] = -st->n.orientation[1] * iVar28 + st->n.orientation[2] * howHard + st->n.orientation[3] * iVar9 + 0x800 >> 0xc;
						piVar18[4] = (st->n.orientation[0] * iVar28 - st->n.orientation[2] * iVar9) + st->n.orientation[3] * howHard + 0x800 >> 0xc;
						piVar18[5] = -st->n.orientation[0] * howHard + st->n.orientation[1] * iVar9 + st->n.orientation[3] * iVar28 + 0x800 >> 0xc;
						piVar18[6] = ((-st->n.orientation[0] * iVar9 - st->n.orientation[1] * howHard) - st->n.orientation[2] * iVar28) + 0x800 >> 0xc;

						piVar18[7] = 0;
						piVar18[8] = 0;
						piVar18[9] = 0;
						piVar18[10] = 0;
						piVar18[0xb] = 0;
						piVar18[0xc] = 0;

						local_48 = 0;

						if (0 < local_40) 
						{
							local_30 = 0;
							p_Var27 = local_4c;

							do {
								c1 = active_car_list[local_48];
								p_Var25 = &c1->st;

								if (0 < RKstep)
									p_Var25 = &_tp[local_30]; //(RigidBodyState *)((int)_tp[0].v + local_30);

								if (((c1->hd).mayBeColliding != 0) && (((c1->hd).speed != 0 || ((cp->hd).speed != 0))))
								{

									iVar28 = (cp->hd).where.t[0];
									iVar19 = (cp->hd).where.t[1];
									howHard = (cp->hd).where.t[2];

									iVar21 = (c1->hd).where.t[0];
									iVar9 = (c1->hd).where.t[1];
									iVar24 = (c1->hd).where.t[2];

									uVar6 = cp->id;
									uVar14 =c1->id;

									if ((bbox[uVar14].x0 < bbox[uVar6].x1) &&
										(((bbox[uVar14].z0 < bbox[uVar6].z1 &&
										(bbox[uVar6].x0 < bbox[uVar14].x1)) &&
											((bbox[uVar6].z0 < bbox[uVar14].z1 &&
											(((bbox[uVar14].y0 < bbox[uVar6].y1 &&
												(bbox[uVar6].y0 < bbox[uVar14].y1)) &&
												(iVar11 = CarCarCollision3(cp, c1, &local_58,
												(VECTOR *)collisionpoint,
													(VECTOR *)normal), iVar11 != 0)
												))))))) 
									{
										collisionpoint[1] = collisionpoint[1] + -0x3c;
										lever0[0] = collisionpoint[0] - iVar28;
										lever0[2] = collisionpoint[2] - howHard;
										lever1[0] = collisionpoint[0] - iVar21;
										lever1[2] = collisionpoint[2] - iVar24;
										iVar19 = collisionpoint[1] - iVar19;
										iVar9 = collisionpoint[1] - iVar9;
										iVar28 = 0x2f - (iVar19 + iVar9) / 2;
										lever0[1] = iVar19 + iVar28;
										lever1[1] = iVar9 + iVar28;
										iVar28 = local_58 * 0xc000;

										howHard = (((st->n.angularVelocity[1] * lever0[2] -
											st->n.angularVelocity[2] * lever0[1]) + 0x800 >>
											0xc) + st->n.linearVelocity[0]) -
											(((p_Var25->n.angularVelocity[1] * lever1[2] -
												p_Var25->n.angularVelocity[2] * lever1[1]) + 0x800
												>> 0xc) + p_Var25->n.linearVelocity[0]);
										iVar19 = (((st->n.angularVelocity[2] * lever0[0] -
											st->n.angularVelocity[0] * lever0[2]) + 0x800 >>
											0xc) + st->n.linearVelocity[1]) -
											(((p_Var25->n.angularVelocity[2] * lever1[0] -
												p_Var25->n.angularVelocity[0] * lever1[2]) + 0x800
												>> 0xc) + p_Var25->n.linearVelocity[1]);
										iVar9 = (((st->n.angularVelocity[0] * lever0[1] -
											st->n.angularVelocity[1] * lever0[0]) + 0x800 >> 0xc
											) + st->n.linearVelocity[2]) -
											(((p_Var25->n.angularVelocity[0] * lever1[1] -
												p_Var25->n.angularVelocity[1] * lever1[0]) + 0x800
												>> 0xc) + p_Var25->n.linearVelocity[2]);

										if (howHard < 0) 
										{
											howHard = howHard + 0xff;
										}

										lVar10 = normal[0];
										if (normal[0] < 0) 
										{
											lVar10 = normal[0] + 0x1f;
										}

										if (iVar19 < 0) 
										{
											iVar19 = iVar19 + 0xff;
										}

										lVar7 = normal[1];
										if (normal[1] < 0) 
											lVar7 = normal[1] + 0x1f;

										if (iVar9 < 0)
											iVar9 = iVar9 + 0xff;

										lVar8 = normal[2];
										if (normal[2] < 0)
											lVar8 = normal[2] + 0x1f;

										howHard = (howHard >> 8) * (lVar10 >> 5) + (iVar19 >> 8) * (lVar7 >> 5) + (iVar9 >> 8) * (lVar8 >> 5);

										if ((0 < howHard) && (-1 < RKstep))
										{
											iVar9 = DamageCar3D(cp, (long(*)[4])lever0, howHard >> 1, c1);
											if (iVar9 != 0) 
												cp->ap.needsDenting = 1;

											iVar9 = DamageCar3D(c1, (long(*)[4])lever1, howHard >> 1, cp);
											if (iVar9 != 0) 
												c1->ap.needsDenting = 1;

											if (0x32000 < howHard) 
											{
												if (cp->controlType == 2) 
													cp->ai.c.carMustDie = 1;

												if (c1->controlType == 2) 
													c1->ai.c.carMustDie = 1;
											}

											if (((numCopCars < 4) && (numActiveCops < maxCopCars)) && (GameType != GAME_GETAWAY))
											{
												if ((cp->controlType == 1) && ((*(uint *)&c1->hndType & 0x2ff00) == 0x20200))
												{
													InitCopState(c1, NULL);
													c1->ai.p.justPinged = 0;
												}
												if ((c1->controlType == 1) && ((*(uint *)&cp->hndType & 0x2ff00) == 0x20200))
												{
													InitCopState(cp, NULL);
													cp->ai.p.justPinged = 0;
												}
											}

											if (0x1b00 < howHard) 
											{
												velocity.vy = -0x11;
												velocity.vx = cp->st.n.linearVelocity[0] >> 0xc;
												collisionpoint[1] = -collisionpoint[1];
												velocity.vz = cp->st.n.linearVelocity[2] >> 0xc;

												if ((cp->controlType == 1) || (c1->controlType == 1))
												{
													Setup_Sparks((VECTOR *)collisionpoint, &velocity, 6, 0);

													if (cp->controlType == 1) 
														SetPadVibration((int)cp->ai.padid, 1);

													if (c1->controlType == 1)
														SetPadVibration((int)c1->ai.padid, 1);
												}

												if (0x2400 < howHard) 
												{
													iVar9 = GetDebrisColour(cp);
													iVar19 = GetDebrisColour(c1);

													Setup_Debris((VECTOR *)collisionpoint, &velocity, 3, 0);
													Setup_Debris((VECTOR *)collisionpoint, &velocity, 6, iVar9 << 0x10);
													Setup_Debris((VECTOR *)collisionpoint, &velocity, 2, iVar19 << 0x10);
												}
											}
										}
										iVar9 = howHard * 9;
										if (iVar9 < 0) {
											iVar9 = iVar9 + 3;
										}
										iVar28 = iVar28 + (iVar9 >> 2);

										if (0x69000 < iVar28) 
											iVar28 = 0x69000;

										iVar19 = cp->ap.carCos->mass;
										iVar9 = c1->ap.carCos->mass;
										uVar1 = cp->controlType;
										uVar2 = c1->controlType;

										if (iVar9 < iVar19)
										{
											iVar24 = (iVar9 << 0xc) / iVar19;

											if (iVar19 == 0) 
											{
												trap(7);
											}

											iVar21 = 0x1000;
										}
										else 
										{
											iVar21 = (iVar19 << 0xc) / iVar9;

											if (iVar9 == 0) 
											{
												trap(7);
											}

											iVar24 = 0x1000;
										}

										if (uVar1 != '\a' && iVar19 != 0x7fff)
										{
											sVar3 = car_cosmetics[cp->ap.model].twistRateY;

											if (((uVar1 == 3) && (uVar2 != 3)) && (c1->hndType != '\0'))
											{
												iVar11 = iVar28 * (7 - gCopDifficultyLevel);
											LAB_00054ae0:
												iVar19 = iVar11 >> 3;
												if (iVar11 < 0)
												{
													iVar19 = iVar11 + 7 >> 3;
												}
											}
											else 
											{
												iVar19 = iVar28;
												if ((uVar1 == 4) && (c1->hndType != 0))
												{
													iVar11 = iVar28 * 5;
													goto LAB_00054ae0;
												}
											}

											iVar19 = (iVar19 + 0x800 >> 0xc) * iVar24 >> 3;
											velocity.vx = (normal[0] >> 3) * iVar19 >> 6;
											velocity.vz = (normal[2] >> 3) * iVar19 >> 6;
											velocity.vy = (normal[1] >> 3) * iVar19 >> 6;

											plVar17 = local_4c->v + local_40 * 5 + local_34 * 4;
											plVar17[7] = plVar17[7] - velocity.vx;
											plVar17[8] = plVar17[8] - velocity.vy;
											plVar17[9] = plVar17[9] - velocity.vz;

											iVar19 = (int)sVar3 >> 1;
											torque[0] = ((velocity.vy * lever0[2] - velocity.vz * lever0[1]) + 0x800 >> 0xc) * iVar19;
											torque[2] = ((velocity.vx * lever0[1] - velocity.vy * lever0[0]) + 0x800 >> 0xc) * iVar19;

											if (c1->controlType == 4) 
											{
												torque[0] = 0;
												torque[2] = 0;
											}

											plVar17[10] = plVar17[10] + torque[0];
											plVar17[0xb] = plVar17[0xb] + ((velocity.vz * lever0[0] -velocity.vx * lever0[2]) + 0x800 >> 0xc) * iVar19;
											plVar17[0xc] = plVar17[0xc] + torque[2];
										}

										if (uVar2 != '\a' && iVar9 != 0x7fff)
										{
											sVar3 = car_cosmetics[c1->ap.model].twistRateY;

											if (((cp->controlType == 3) ||
												(c1->controlType != 3)) ||
												(c1->hndType == 0)) 
											{
												if ((c1->controlType == 4) && (cp->hndType != 0))
												{
													iVar9 = iVar28 * 5;
													goto LAB_00054d38;
												}
											}
											else 
											{
												iVar9 = iVar28 * (7 - gCopDifficultyLevel);
											LAB_00054d38:
												iVar28 = iVar9 >> 3;
												if (iVar9 < 0)
												{
													iVar28 = iVar9 + 7 >> 3;
												}
											}

											iVar28 = (iVar28 + 0x800 >> 0xc) * iVar21 >> 3;
											velocity.vx = (normal[0] >> 3) * iVar28 >> 6;
											velocity.vy = (normal[1] >> 3) * iVar28 >> 6;
											velocity.vz = (normal[2] >> 3) * iVar28 >> 6;

											iVar28 = p_Var27->n.linearVelocity[1];
											p_Var27->n.linearVelocity[0] = p_Var27->n.linearVelocity[0] + velocity.vx;
											p_Var27->n.linearVelocity[1] = iVar28 + velocity.vy;
											p_Var27->n.linearVelocity[2] = p_Var27->n.linearVelocity[2] + velocity.vz;
											iVar28 = (int)sVar3 >> 1;

											torque[0] = ((lever1[1] * velocity.vz - lever1[2] * velocity.vy) + 0x800 >> 0xc) * iVar28;
											torque[2] = ((lever1[0] * velocity.vy - lever1[1] * velocity.vx) + 0x800 >> 0xc) * iVar28;

											if (c1->controlType == 4) 
											{
												torque[0] = 0;
												torque[2] = 0;
											}

											iVar9 = p_Var27->n.angularVelocity[1];
											p_Var27->n.angularVelocity[0] =p_Var27->n.angularVelocity[0] + torque[0];
											p_Var27->n.angularVelocity[1] = iVar9 + ((lever1[2] * velocity.vx - lever1[0] * velocity.vz) + 0x800 >> 0xc) * iVar28;
											p_Var27->n.angularVelocity[2] = p_Var27->n.angularVelocity[2] + torque[2];
										}
										if ((cp->id == player[0].playerCarId) ||
											(c1->id == player[0].playerCarId)) 
										{
											RegisterChaseHit(cp->id, c1->id);
										}

										if (cp->id == player[0].playerCarId)
										{
											CarHitByPlayer(c1, howHard);
										}

										if (c1->id == player[0].playerCarId) 
										{
											CarHitByPlayer(cp, howHard);
										}
									}
								}
								p_Var27 = p_Var27 + 1;
								local_30 = local_30 + 1;// +sizeof(RigidBodyState); 0x34;
								local_48 = local_48 + 1;
							} while (local_48 < local_40);
						}
					}
					local_40 = local_40 + 1;
					howHard = local_40 * 4;
					iVar28 = num_active_cars;
				} while (local_40 < num_active_cars);
			}
			if (0 < iVar28) {
				iVar9 = 0;
				howHard = 0;
				do {
					cp = *(_CAR_DATA **)((int)active_car_list + iVar9);
					iVar19 = howHard + 1;

					if ((cp->hd).mayBeColliding != 0)
					{
						if (RKstep == 0) 
						{
							iVar28 = 0xc;
							plVar23 = _tp[howHard].n.angularVelocity + 2;
							piVar18 = (cp->st).n.angularVelocity + 2;
							plVar17 = _d0[howHard].n.angularVelocity + 2;

							do {
								iVar21 = *piVar18;
								piVar18 = piVar18 + -1;
								iVar9 = *plVar17;
								plVar17 = plVar17 + -1;
								iVar28 = iVar28 + -1;
								*plVar23 = iVar21 + (iVar9 >> 2);
								plVar23 = plVar23 + -1;
							} while (-1 < iVar28);

							RebuildCarMatrix((RigidBodyState *)(_tp + howHard), cp);
						}
						else 
						{
							iVar28 = 0xc;
							if (RKstep == 1) 
							{
								plVar23 = _d1[howHard].n.angularVelocity + 2;
								plVar17 = _d0[howHard].n.angularVelocity + 2;
								piVar18 = (cp->st).n.angularVelocity + 2;

								do {
									iVar9 = *plVar23;
									plVar23 = plVar23 + -1;
									howHard = *plVar17;
									plVar17 = plVar17 + -1;
									iVar28 = iVar28 + -1;
									*piVar18 = *piVar18 + (howHard + iVar9 >> 3);
									piVar18 = piVar18 + -1;
								} while (-1 < iVar28);

								RebuildCarMatrix((RigidBodyState *)&cp->st, cp);
							}
						}
					}
					iVar9 = iVar19 * 4;
					iVar28 = num_active_cars;
					howHard = iVar19;
				} while (iVar19 < num_active_cars);
			}
			RKstep = iVar5;
		} while (iVar5 < 2);

		iVar5 = 0;
		subframe = iVar15;

		if (3 < iVar15) 
		{
			iVar15 = 0;
			if (0 < iVar28) {
				pp_Var26 = active_car_list;
				do {
					cp = *pp_Var26;

					// [A] pls replace me
					uVar6 = *(uint *)((cp->hd).where.m + 2);
					*(uint *)(cp->hd).drawCarMat.m = ~*(uint *)(cp->hd).where.m;
					*(uint *)((cp->hd).drawCarMat.m + 2) = uVar6 ^ 0xffff;
					*(uint *)((cp->hd).drawCarMat.m + 4) =*(uint *)((cp->hd).where.m + 4);
					*(uint *)((cp->hd).drawCarMat.m + 6) = ~*(uint *)((cp->hd).where.m + 6);
					*(uint *)((cp->hd).drawCarMat.m + 8) = *(uint *)((cp->hd).where.m + 8) ^ 0xffff;

					if (((cp->ap).needsDenting != '\0') && (((CameraCnt + iVar15 & 3U) == 0 || (iVar5 < 5)))) 
					{
						DentCar(cp);
						(cp->ap).needsDenting = '\0';
						iVar5 = iVar5 + 1;
					}

					pp_Var26 = pp_Var26 + 1;
					lVar10 = ratan2((int)(cp->hd).where.m[2], (int)(cp->hd).where.m[8]);
					iVar15 = iVar15 + 1;
					bVar4 = iVar15 < num_active_cars;
					(cp->hd).direction = lVar10;
				} while (bVar4);
			}
			return;
		}
	} while (true);
}



// decompiled code
// original method signature: 
// void /*$ra*/ SetShadowPoints(struct _CAR_DATA *c0 /*$s4*/)
 // line 1704, offset 0x000551ec
	/* begin block 1 */
		// Start line: 1705
		// Start offset: 0x000551EC
		// Variables:
	// 		int j; // $s2
	// 		struct CAR_COSMETICS *car_cos; // $v1
	// 		struct _sdPlane *surfacePtr; // stack offset -48

		/* begin block 1.1 */
			// Start line: 1718
			// Start offset: 0x000552A8
			// Variables:
		// 		struct SVECTOR disp; // stack offset -104
		// 		struct VECTOR pointPos; // stack offset -96
		// 		struct VECTOR surfaceNormal; // stack offset -80
		// 		struct VECTOR surfacePoint; // stack offset -64
		/* end block 1.1 */
		// End offset: 0x00055388
		// End Line: 1739
	/* end block 1 */
	// End offset: 0x000553CC
	// End Line: 1741

	/* begin block 2 */
		// Start line: 4674
	/* end block 2 */
	// End Line: 4675

	/* begin block 3 */
		// Start line: 4694
	/* end block 3 */
	// End Line: 4695

	/* begin block 4 */
		// Start line: 4700
	/* end block 4 */
	// End Line: 4701

/* WARNING: Could not reconcile some variable overlaps */

// [D]
void SetShadowPoints(_CAR_DATA *c0)
{
	bool bVar1;
	uint uVar2;
	uint *puVar3;
	SVECTOR *pSVar5;
	int iVar6;
	SVECTOR disp;
	VECTOR pointPos;
	VECTOR surfaceNormal;
	VECTOR surfacePoint;

	_sdPlane *surfacePtr;
	surfacePtr = NULL;

	gte_SetRotMatrix(&c0->hd.where);
	gte_SetTransMatrix(&c0->hd.where);

	iVar6 = 0;
	pSVar5 = car_cosmetics[c0->ap.model].cPoints;

	do {
		disp = *pSVar5;

		/* // [A] No point to keep this cheat
		if (cheats.MiniCars != 0) 
		{
			disp._0_4_ = CONCAT22((short)((int)disp._0_4_ >> 0x12), disp.vx >> 2);
			disp._4_4_ = disp._4_4_ & 0xffff0000 | (uint)(ushort)(disp.vz >> 2);
		}*/

		gte_ldv0(&disp);

		docop2(0x480012);

		pointPos.vx = MAC1; // getCopReg(2, 0x19);
		pointPos.vy = MAC2; // getCopReg(2, 0x1a);
		pointPos.vz = MAC3; // getCopReg(2, 0x1b);

		static int hSubShad = 0;

		hSubShad = 0;

		FindSurfaceD2(&pointPos, &surfaceNormal, &surfacePoint, &surfacePtr);

		c0->hd.shadowPoints[iVar6].vx = surfacePoint.vx;
		c0->hd.shadowPoints[iVar6].vy = surfacePoint.vy;
		c0->hd.shadowPoints[iVar6].vz = surfacePoint.vz;

		puVar3 = (uint *)&(c0->hd).shadowPoints[iVar6].vy;
		uVar2 = *puVar3;

		bVar1 = hSubShad != 0;

		*puVar3 = uVar2 & 0xfffffffe;

		if (bVar1)
			*puVar3 = uVar2 & 0xfffffffe | 1;

		iVar6 = iVar6 + 1;
		pSVar5 = pSVar5 + 1;

	} while (iVar6 < 4);
}



// decompiled code
// original method signature: 
// void /*$ra*/ LongQuaternion2Matrix(long (*qua)[4] /*$a0*/, struct MATRIX *m /*$a1*/)
 // line 1753, offset 0x000553cc
	/* begin block 1 */
		// Start line: 1754
		// Start offset: 0x000553CC
		// Variables:
	// 		int xx; // $t3
	// 		int xy; // $a3
	// 		int xz; // $t2
	// 		int xw; // $t0
	// 		int yy; // $t7
	// 		int yz; // $a2
	// 		int yw; // $t5
	// 		int zz; // $v1
	// 		int zw; // $a0
	/* end block 1 */
	// End offset: 0x000554F0
	// End Line: 1778

	/* begin block 2 */
		// Start line: 4819
	/* end block 2 */
	// End Line: 4820

	/* begin block 3 */
		// Start line: 4832
	/* end block 3 */
	// End Line: 4833

	/* begin block 4 */
		// Start line: 4833
	/* end block 4 */
	// End Line: 4834

// [D]
void LongQuaternion2Matrix(long(*qua)[4], MATRIX *m)
{
	short sVar1;
	short sVar2;
	short sVar3;
	short sVar4;
	int iVar5;
	int iVar6;
	int iVar7;
	int iVar8;

	iVar6 = (*qua)[0];
	iVar5 = (*qua)[1];
	iVar8 = (*qua)[2];
	iVar7 = (*qua)[3];

	sVar1 = (iVar5 * iVar5 + 0x400 >> 0xb);
	sVar2 = (iVar8 * iVar8 + 0x400 >> 0xb);
	sVar3 = (iVar6 * iVar6 + 0x400 >> 0xb);

	m->m[0][0] = 0x1000 - (sVar1 + sVar2);
	m->m[1][1] = 0x1000 - (sVar3 + sVar2);
	m->m[2][2] = 0x1000 - (sVar3 + sVar1);

	sVar2 = (iVar8 * iVar7 + 0x400 >> 0xb);
	sVar1 = (iVar6 * iVar5 + 0x400 >> 0xb);

	m->m[0][1] = sVar1 - sVar2;

	sVar3 = (iVar6 * iVar8 + 0x400 >> 0xb);
	sVar4 = (iVar5 * iVar7 + 0x400 >> 0xb);

	m->m[0][2] = sVar3 + sVar4;
	m->m[1][0] = sVar1 + sVar2;
	m->m[2][0] = sVar3 - sVar4;

	sVar2 = (iVar6 * iVar7 + 0x400 >> 0xb);
	sVar1 = (iVar5 * iVar8 + 0x400 >> 0xb);

	m->m[1][2] = sVar1 - sVar2;
	m->m[2][1] = sVar1 + sVar2;
}



// decompiled code
// original method signature: 
// void /*$ra*/ initOBox(struct _CAR_DATA *cp /*$a2*/)
 // line 1802, offset 0x000554f0
	/* begin block 1 */
		// Start line: 1803
		// Start offset: 0x000554F0
		// Variables:
	// 		struct SVECTOR *boxDisp; // $a0

		/* begin block 1.1 */
			// Start line: 1803
			// Start offset: 0x000554F0
			// Variables:
		// 		int length; // $a1
		/* end block 1.1 */
		// End offset: 0x000556E0
		// End Line: 1842
	/* end block 1 */
	// End offset: 0x000556E0
	// End Line: 1844

	/* begin block 2 */
		// Start line: 4994
	/* end block 2 */
	// End Line: 4995

	/* begin block 3 */
		// Start line: 5019
	/* end block 3 */
	// End Line: 5020

// [D]
void initOBox(_CAR_DATA *cp)
{
	short sVar2;
	int iVar3;
	long uVar4;
	long uVar5;
	long uVar6;

	gte_SetRotMatrix(&cp->hd.where);
	gte_SetTransMatrix(&cp->hd.where);

	VX0 = -(((cp->ap).carCos)->cog).vx;
	VY0 = -(((cp->ap).carCos)->cog).vy;
	VZ0 = -(((cp->ap).carCos)->cog).vz;

	docop2(0x480012);

	if (cp->controlType == '\x03') 
	{
		iVar3 = (int)(((cp->ap).carCos)->colBox).vx * 0xe;
		if (iVar3 < 0)
		{
			iVar3 = iVar3 + 0xf;
		}
		sVar2 = (short)(iVar3 >> 4);
		(cp->hd).oBox.length[0] = sVar2;
	}
	else 
	{
		sVar2 = (((cp->ap).carCos)->colBox).vx;
		(cp->hd).oBox.length[0] = sVar2;
	}

	(cp->hd).oBox.location.vx = MAC1;
	(cp->hd).oBox.location.vy = MAC2;
	(cp->hd).oBox.location.vz = MAC3;

	IR1 = sVar2;
	IR2 = 0;
	IR3 = 0;

	docop2(0x49e012);

	sVar2 = (((cp->ap).carCos)->colBox).vy;
	(cp->hd).oBox.length[1] = sVar2;

	(cp->hd).oBox.radii[0].vx = IR1;
	(cp->hd).oBox.radii[0].vy = IR2;
	(cp->hd).oBox.radii[0].vz = IR3;

	IR1 = 0;
	IR2 = sVar2;
	IR3 = 0;

	docop2(0x49e012);

	sVar2 = (((cp->ap).carCos)->colBox).vz;
	(cp->hd).oBox.length[2] = sVar2;

	(cp->hd).oBox.radii[1].vx = IR1;
	(cp->hd).oBox.radii[1].vy = IR2;
	(cp->hd).oBox.radii[1].vz = IR3;

	IR1 = 0;
	IR2 = 0;
	IR3 = sVar2;

	docop2(0x49e012);

	uVar4 = getCopReg(2, 0x4800);
	uVar5 = getCopReg(2, 0x5000);
	uVar6 = getCopReg(2, 0x5800);

	(cp->hd).oBox.radii[2].vx = IR1;
	(cp->hd).oBox.radii[2].vy = IR2;
	(cp->hd).oBox.radii[2].vz = IR3;
}



// decompiled code
// original method signature: 
// void /*$ra*/ RebuildCarMatrix(union RigidBodyState *st /*$a2*/, struct _CAR_DATA *cp /*$s0*/)
 // line 1854, offset 0x00056ae4
	/* begin block 1 */
		// Start line: 1855
		// Start offset: 0x00056AE4

		/* begin block 1.1 */
			// Start line: 1855
			// Start offset: 0x00056AE4
			// Variables:
		// 		int sm; // $v1

			/* begin block 1.1.1 */
				// Start line: 1859
				// Start offset: 0x00056B8C
				// Variables:
			// 		int osm; // $v0
			/* end block 1.1.1 */
			// End offset: 0x00056C00
			// End Line: 1859
		/* end block 1.1 */
		// End offset: 0x00056C00
		// End Line: 1859
	/* end block 1 */
	// End offset: 0x00056C24
	// End Line: 1862

	/* begin block 2 */
		// Start line: 3708
	/* end block 2 */
	// End Line: 3709

// [D]
void RebuildCarMatrix(RigidBodyState *st, _CAR_DATA *cp)
{
	int iVar1;
	int iVar2;
	int iVar3;
	int iVar4;
	int iVar5;
	int iVar6;

	cp->hd.where.t[0] = st->n.fposition[0] >> 4;
	cp->hd.where.t[1] = st->n.fposition[1] >> 4;
	cp->hd.where.t[2] = st->n.fposition[2] >> 4;

	iVar6 = st->n.orientation[0];
	iVar5 = st->n.orientation[1];
	iVar4 = st->n.orientation[2];
	iVar3 = st->n.orientation[3];

	iVar2 = iVar6 * iVar6 + iVar5 * iVar5 + iVar4 * iVar4 + iVar3 * iVar3;
	iVar1 = 0x1000;

	if (iVar2 < 0x400)
	{
		st->n.orientation[2] = 0;
		st->n.orientation[1] = 0;
		st->n.orientation[0] = 0;
	}
	else 
	{
		iVar1 = 0x1800 - (iVar2 >> 0xd);
		st->n.orientation[0] = iVar1 * iVar6 + 0x800 >> 0xc;
		st->n.orientation[1] = iVar1 * iVar5 + 0x800 >> 0xc;
		st->n.orientation[2] = iVar1 * iVar4 + 0x800 >> 0xc;
		iVar1 = iVar1 * iVar3 + 0x800 >> 0xc;
	}

	st->n.orientation[3] = iVar1;

	LongQuaternion2Matrix((long(*)[4])st->n.orientation, (MATRIX *)&cp->hd.where);

	initOBox(cp);
}



// decompiled code
// original method signature: 
// void /*$ra*/ StepCarPhysics(struct _CAR_DATA *cp /*$a2*/)
 // line 1875, offset 0x00056a0c
	/* begin block 1 */
		// Start line: 1876
		// Start offset: 0x00056A0C
		// Variables:
	// 		struct _HANDLING_TYPE *hp; // $v0
	/* end block 1 */
	// End offset: 0x00056A64
	// End Line: 1899

	/* begin block 2 */
		// Start line: 3750
	/* end block 2 */
	// End Line: 3751



// [D]
void StepCarPhysics(_CAR_DATA *cp)
{
	unsigned char bVar1;

	bVar1 = cp->hndType;
	if (cp->controlType != '\0')
	{
		if (bVar1 == 1)
			handlingType[bVar1].aggressiveBraking = 0;
		else 
			handlingType[bVar1].aggressiveBraking = 1;

		active_car_list[num_active_cars] = cp;
		num_active_cars++;
	}
}



// decompiled code
// original method signature: 
// void /*$ra*/ InitialiseCarHandling()
 // line 1911, offset 0x00056a6c
	/* begin block 1 */
		// Start line: 6067
	/* end block 1 */
	// End Line: 6068

	/* begin block 2 */
		// Start line: 6072
	/* end block 2 */
	// End Line: 6073

/* WARNING: Unknown calling convention yet parameter storage is locked */

// [D]
void InitialiseCarHandling(void)
{
	return;
}



// decompiled code
// original method signature: 
// void /*$ra*/ CheckCarToCarCollisions()
 // line 1930, offset 0x000556e0
	/* begin block 1 */
		// Start line: 1932
		// Start offset: 0x000556E0
		// Variables:
	// 		struct _CAR_DATA *cp; // $t2
	// 		struct BOUND_BOX *bp; // $t1
	// 		struct BOUND_BOX *bb1; // $t0
	// 		struct BOUND_BOX *bb2; // $a1
	// 		int lbod; // $v1
	// 		int wbod; // $a0
	// 		int hbod; // $t0
	// 		struct SVECTOR *colBox; // $a1
	// 		int loop1; // $t4
	// 		int loop2; // $a3

		/* begin block 1.1 */
			// Start line: 1947
			// Start offset: 0x0005570C
			// Variables:
		// 		int wx; // $v1
		// 		int wz; // $a2
		/* end block 1.1 */
		// End offset: 0x0005592C
		// End Line: 1982
	/* end block 1 */
	// End offset: 0x00055A94
	// End Line: 2014

	/* begin block 2 */
		// Start line: 5188
	/* end block 2 */
	// End Line: 5189

	/* begin block 3 */
		// Start line: 5190
	/* end block 3 */
	// End Line: 5191

	/* begin block 4 */
		// Start line: 5277
	/* end block 4 */
	// End Line: 5278

	/* begin block 5 */
		// Start line: 5278
	/* end block 5 */
	// End Line: 5279

/* WARNING: Unknown calling convention yet parameter storage is locked */


void CheckCarToCarCollisions(void)
{
	UNIMPLEMENTED();
	/*
	uchar uVar1;
	int iVar2;
	CAR_COSMETICS *pCVar3;
	int iVar4;
	int iVar5;
	BOUND_BOX *pBVar6;
	int iVar7;
	BOUND_BOX *pBVar8;
	_CAR_DATA *p_Var9;
	char *pcVar10;
	int iVar11;
	int iVar12;
	int iVar13;

	p_Var9 = car_data;
	if (ghost_mode == 0) {
		pBVar8 = bbox;
		pcVar10 = &car_data[0].hd.mayBeColliding;
		iVar11 = 0x13;
		do {
			pCVar3 = (p_Var9->ap).carCos;
			iVar7 = (int)(pCVar3->colBox).vy;
			iVar2 = (int)(pCVar3->colBox).vz * 9;
			if (iVar2 < 0) {
				iVar2 = iVar2 + 7;
			}
			iVar12 = (int)(p_Var9->hd).where.m[2] * (iVar2 >> 3);
			iVar4 = (int)(pCVar3->colBox).vx * 9;
			if (iVar12 < 0) {
				iVar12 = -iVar12;
			}
			if (iVar4 < 0) {
				iVar4 = iVar4 + 7;
			}
			iVar13 = (int)(p_Var9->hd).where.m[0] * (iVar4 >> 3);
			if (iVar13 < 0) {
				iVar13 = -iVar13;
			}
			iVar12 = (iVar12 + iVar13 + 0x800 >> 0xc) + iVar7;
			iVar2 = (int)(p_Var9->hd).where.m[8] * (iVar2 >> 3);
			if (iVar2 < 0) {
				iVar2 = -iVar2;
			}
			iVar4 = (int)(p_Var9->hd).where.m[6] * (iVar4 >> 3);
			iVar13 = (p_Var9->hd).where.t[0];
			iVar5 = iVar13 - iVar12;
			if (iVar4 < 0) {
				iVar4 = -iVar4;
			}
			iVar7 = (iVar2 + iVar4 + 0x800 >> 0xc) + iVar7;
			if (iVar5 < 0) {
				iVar5 = iVar5 + 0xf;
			}
			iVar4 = (p_Var9->hd).where.t[2];
			iVar2 = iVar4 - iVar7;
			pBVar8->x0 = iVar5 >> 4;
			if (iVar2 < 0) {
				iVar2 = iVar2 + 0xf;
			}
			pBVar8->z0 = iVar2 >> 4;
			iVar13 = iVar13 + iVar12;
			if (iVar13 < 0) {
				iVar13 = iVar13 + 0xf;
			}
			iVar4 = iVar4 + iVar7;
			pBVar8->x1 = iVar13 >> 4;
			if (iVar4 < 0) {
				iVar4 = iVar4 + 0xf;
			}
			iVar2 = *(int *)(p_Var9->st + 0x1c);
			pBVar8->z1 = iVar4 >> 4;
			if (iVar2 < 0) {
				iVar2 = iVar2 + 0x800 >> 0xc;
				if (iVar2 < 0) {
					iVar2 = iVar2 + 7;
				}
				pBVar8->x0 = (iVar5 >> 4) + (iVar2 >> 3);
			}
			else {
				iVar2 = iVar2 + 0x800 >> 0xc;
				if (iVar2 < 0) {
					iVar2 = iVar2 + 7;
				}
				pBVar8->x1 = (iVar13 >> 4) + (iVar2 >> 3);
			}
			iVar2 = *(int *)(p_Var9->st + 0x24);
			if (iVar2 < 0) {
				iVar2 = iVar2 + 0x800 >> 0xc;
				if (iVar2 < 0) {
					iVar2 = iVar2 + 7;
				}
				pBVar8->z0 = pBVar8->z0 + (iVar2 >> 3);
			}
			else {
				iVar2 = iVar2 + 0x800 >> 0xc;
				if (iVar2 < 0) {
					iVar2 = iVar2 + 7;
				}
				pBVar8->z1 = pBVar8->z1 + (iVar2 >> 3);
			}
			iVar7 = (p_Var9->hd).where.t[1];
			iVar2 = iVar7 + -0x960;
			if (iVar2 < 0) {
				iVar2 = iVar7 + -0x951;
			}
			pBVar8->y0 = iVar2 >> 4;
			iVar2 = iVar7 + 0x960;
			if (iVar2 < 0) {
				iVar2 = iVar7 + 0x96f;
			}
			uVar1 = p_Var9->hndType;
			pBVar8->y1 = iVar2 >> 4;
			if (uVar1 == '\0') {
				*pcVar10 = '\x01';
			}
			pcVar10 = pcVar10 + 0x29c;
			iVar11 = iVar11 + -1;
			pBVar8 = pBVar8 + 1;
			p_Var9 = p_Var9 + 1;
		} while (-1 < iVar11);
		pBVar8 = bbox;
		iVar11 = 0;
		do {
			iVar2 = iVar11 + 1;
			if (iVar2 < 0x14) {
				iVar4 = iVar2 * 0x29c;
				pBVar6 = pBVar8 + 1;
				iVar7 = iVar2;
				do {
					if ((((((pBVar6->x0 < pBVar8->x1) && (pBVar6->z0 < pBVar8->z1)) &&
						(pBVar8->x0 < pBVar6->x1)) &&
						((pBVar8->z0 < pBVar6->z1 && (pBVar6->y0 < pBVar8->y1)))) &&
						((pBVar8->y0 < pBVar6->y1 && ((iVar11 == 0 || (car_data[iVar11].controlType != '\0')))
							))) && ((&car_data[0].controlType)[iVar4] != '\0')) {
						car_data[iVar11].hd.mayBeColliding = '\x01';
						(&car_data[0].hd.mayBeColliding)[iVar4] = '\x01';
					}
					iVar4 = iVar4 + 0x29c;
					iVar7 = iVar7 + 1;
					pBVar6 = pBVar6 + 1;
				} while (iVar7 < 0x14);
			}
			pBVar8 = pBVar8 + 1;
			iVar11 = iVar2;
		} while (iVar2 < 0x14);
	}
	return;*/
}



// decompiled code
// original method signature: 
// void /*$ra*/ ProcessCarPad(struct _CAR_DATA *cp /*$s0*/, unsigned long pad /*$s3*/, char PadSteer /*$s4*/, char use_analogue /*$s5*/)
 // line 2027, offset 0x00055a9c
	/* begin block 1 */
		// Start line: 2028
		// Start offset: 0x00055A9C
		// Variables:
	// 		int player_id; // $s1

		/* begin block 1.1 */
			// Start line: 2158
			// Start offset: 0x00055CD8
			// Variables:
		// 		int int_steer; // $v0
		// 		int analog_angle; // $v1
		/* end block 1.1 */
		// End offset: 0x00055D90
		// End Line: 2180

		/* begin block 1.2 */
			// Start line: 2260
			// Start offset: 0x00055EF0
			// Variables:
		// 		int rws; // $v0
		/* end block 1.2 */
		// End offset: 0x00055F80
		// End Line: 2270

		/* begin block 1.3 */
			// Start line: 2282
			// Start offset: 0x00055FE4
			// Variables:
		// 		int playerCar; // $v0
		// 		int dist; // $a0
		// 		int dx; // $a0
		// 		int dz; // $v0
		/* end block 1.3 */
		// End offset: 0x00056080
		// End Line: 2299

		/* begin block 1.4 */
			// Start line: 2303
			// Start offset: 0x00056090
			// Variables:
		// 		int targetCarId; // $v1

			/* begin block 1.4.1 */
				// Start line: 2320
				// Start offset: 0x000560D4
				// Variables:
			// 		struct _CAR_DATA *tp; // $a1
			// 		int cx; // $v1
			// 		int cz; // $v0
			// 		int chase_square_dist; // $v0

				/* begin block 1.4.1.1 */
					// Start line: 2327
					// Start offset: 0x0005610C
					// Variables:
				// 		int averagePower; // $a0
				/* end block 1.4.1.1 */
				// End offset: 0x00056148
				// End Line: 2329
			/* end block 1.4.1 */
			// End offset: 0x00056258
			// End Line: 2340
		/* end block 1.4 */
		// End offset: 0x00056258
		// End Line: 2342
	/* end block 1 */
	// End offset: 0x000562AC
	// End Line: 2375

	/* begin block 2 */
		// Start line: 5531
	/* end block 2 */
	// End Line: 5532

#include "DR2ROADS.H"

void ProcessCarPad(_CAR_DATA *cp, ulong pad, char PadSteer, char use_analogue)
{
	UNIMPLEMENTED();

	extern MATRIX camera_matrix;

	// [A]
	if ((pad & 4) == 0) {
		if ((pad & 0x2000) != 0) 
		{
			//RotMatrixY(3200, &cp->hd.where);
			cp->hd.direction += 30;
		}

		if ((pad & 0x8000) != 0) 
		{
			cp->hd.direction -= 30;
			//RotMatrixY(-3200, &cp->hd.where);
		}

		if ((pad & 0x40) != 0)
		{
			cp->st.n.fposition[1] += 50;
		}

		if ((pad & 0x80) != 0)
		{
			cp->st.n.fposition[1] -= 50;
		}

		if ((pad & 0x1000) != 0) 
		{
			cp->st.n.fposition[0] += camera_matrix.m[0][2] / 2;
			cp->st.n.fposition[2] += camera_matrix.m[2][2] / 2;
		}

		if ((pad & 0x4000) != 0)
		{
			cp->st.n.fposition[0] -= camera_matrix.m[0][2] / 2;
			cp->st.n.fposition[2] -= camera_matrix.m[2][2] / 2;
		}
	}
	
	int direction = cp->hd.direction;

	cp->st.n.orientation[0] = -(int)rcossin_tbl[(direction & 0xffeU) + 1] * 5 + 0x800 >> 0xc;
	cp->st.n.orientation[1] = (int)rcossin_tbl[direction & 0xffeU];
	cp->st.n.orientation[2] = rcossin_tbl[direction & 0xffeU] * 5 + 0x800 >> 0xc;
	cp->st.n.orientation[3] = (int)rcossin_tbl[(direction & 0xffeU) + 1];

	RebuildCarMatrix(&cp->st, cp);

	cp->hd.drawCarMat.m[0][0] = -cp->hd.where.m[0][0];
	cp->hd.drawCarMat.m[0][1] = cp->hd.where.m[0][1];
	cp->hd.drawCarMat.m[0][2] = -cp->hd.where.m[0][2];

	cp->hd.drawCarMat.m[1][0] = -cp->hd.where.m[1][0];
	cp->hd.drawCarMat.m[1][1] = cp->hd.where.m[1][1];
	cp->hd.drawCarMat.m[1][2] = -cp->hd.where.m[1][2];

	cp->hd.drawCarMat.m[2][0] = -cp->hd.where.m[2][0];
	cp->hd.drawCarMat.m[2][1] = cp->hd.where.m[2][1];
	cp->hd.drawCarMat.m[2][2] = -cp->hd.where.m[2][2];


	/*
	//int height = MapHeight((VECTOR*)cp->hd.where.t);
	VECTOR normal, out;
	_sdPlane *surfacePtr;
	surfacePtr = NULL;

	FindSurfaceD2((VECTOR*)cp->hd.where.t, &normal, &out, &surfacePtr);
	cp->hd.where.t[1] = out.vy;*/

	/*
	char cVar1;
	short sVar2;
	int i;
	int iVar4;
	byte bVar5;
	CAR_COSMETICS *pCVar6;
	int iVar7;

	iVar7 = (int)PadSteer;
	i = GetPlayerId(cp);
	bVar5 = cp->controlType;
	if (bVar5 == 1) {
		if (((pad & 0x1010) == 0x1010) && (-1 < i)) {
			iVar4 = TannerStuckInCar(1);
			if (iVar4 == 0) {
				if (player.dying == '\0') {
					ActivatePlayerPedestrian(cp, (char *)0x0, 0, (long(*)[4])0x0, 0);
				}
			}
			else {
				if (lockAllTheDoors != '\0') {
					gLockPickingAttempted = (uint)bVar5;
				}
			}
		}
		if (((gStopPadReads != 0) ||
			((&MaxPlayerDamage)[**(char **)cp->ai] <= (int)(uint)cp->totalDamage)) || (gCantDrive != 0))
		{
			pad = 0x10;
			if (0x9000 < (cp->hd).wheel_speed) {
				pad = 0x80;
			}
			iVar7 = 0;
			use_analogue = '\x01';
		}
		if (-1 < i) {
			iVar4 = CarHasSiren((uint)(byte)(cp->ap).model);
			if (iVar4 == 0) {
				bVar5 = (byte)(pad >> 3) & 1;
			}
			else {
				if (((cp->lastPad & 8U) != 0) || ((pad & 8) == 0)) goto LAB_00055c58;
				bVar5 = (&player)[i].horn.on ^ 8;
			}
			(&player)[i].horn.on = bVar5;
		}
	}
LAB_00055c58:
	if ('Z' < (cp->hd).autoBrake) {
		(cp->hd).autoBrake = 'Z';
	}
	if ((pad & 0x10) == 0) {
		cp->handbrake = '\0';
		if ((pad & 0x20) == 0) {
			cp->wheelspin = '\0';
		}
		else {
			cp->wheelspin = '\x01';
		}
		if ((cp->wheelspin != '\0') && (0x6e958 < (cp->hd).wheel_speed)) {
			cp->wheelspin = '\0';
			pad = pad | 0x40;
		}
	}
	else {
		cp->handbrake = '\x01';
	}
	if (use_analogue == '\0') {
		if ((pad & 4) == 0) {
			if (((pad & 0x2000) != 0) &&
				(sVar2 = cp->wheel_angle + 0x20, cp->wheel_angle = sVar2, 0x160 < sVar2)) {
				cp->wheel_angle = 0x160;
			}
			if (((pad & 0x8000) != 0) &&
				(sVar2 = cp->wheel_angle + -0x20, cp->wheel_angle = sVar2, sVar2 < -0x160)) {
				cp->wheel_angle = -0x160;
			}
		}
		else {
			if (((pad & 0x2000) != 0) &&
				(sVar2 = cp->wheel_angle + 0x40, cp->wheel_angle = sVar2, 0x1ff < sVar2)) {
				cp->wheel_angle = 0x1ff;
			}
			if (((pad & 0x8000) != 0) &&
				(sVar2 = cp->wheel_angle + -0x40, cp->wheel_angle = sVar2, sVar2 < -0x1ff)) {
				cp->wheel_angle = -0x1ff;
			}
		}
		if ((pad & 0xa000) != 0) {
			cVar1 = (cp->hd).autoBrake;
			goto code_r0x00055e8c;
		}
		(cp->hd).autoBrake = '\0';
	}
	else {
		if ((pad & 4) == 0) {
			iVar7 = iVar7 * ((iVar7 * iVar7) / 0x50);
			i = (int)((ulonglong)((longlong)iVar7 * 0x66666667) >> 0x20);
		}
		else {
			iVar7 = iVar7 * ((iVar7 * iVar7) / 0x3c);
			i = (int)((ulonglong)((longlong)iVar7 * 0x88888889) >> 0x20);
		}
		i = (i >> 5) - (iVar7 >> 0x1f);
		cp->wheel_angle = (ushort)i & 0xfffc;
		if (i + 0x10eU < 0x21d) {
			(cp->hd).autoBrake = '\0';
		}
		else {
			cVar1 = (cp->hd).autoBrake;
		code_r0x00055e8c:
			(cp->hd).autoBrake = cVar1 + '\x01';
		}
	}
	if ((pad & 0xa000) == 0) {
		if (cp->wheel_angle < -0x40) {
			cp->wheel_angle = cp->wheel_angle + 0x40;
		}
		else {
			if (cp->wheel_angle < 0x41) {
				cp->wheel_angle = 0;
			}
			else {
				cp->wheel_angle = cp->wheel_angle + -0x40;
			}
		}
	}
	if (gTimeInWater != 0) {
		if ((pad & 0x80) != 0) {
			i = (cp->hd).wheel_speed * 0x5dc;
			if (i < 0) {
				i = i + 0x3ff;
			}
			i = (i >> 10) + 0x800 >> 0xc;
			if (-i < 0x17) {
				sVar2 = -5000;
			}
			else {
				sVar2 = (short)((uint)((i + 0x116) * -0x12aa) >> 8);
			}
			cp->thrust = sVar2;
			cp->thrust = (short)((int)cp->thrust * (int)((cp->ap).carCos)->powerRatio + 0x800 >> 0xc);
			goto LAB_00056284;
		}
		if ((pad & 0x40) != 0) {
			pCVar6 = (cp->ap).carCos;
			cp->thrust = 0x1333;
			cp->thrust = (short)((int)pCVar6->powerRatio * 0x1333 + 0x800 >> 0xc);
			if (cp->hndType == '\x05') {
				iVar7 = car_data[player.playerCarId].hd.where.t[0] - (cp->hd).where.t[0] >> 10;
				i = car_data[player.playerCarId].hd.where.t[2] - (cp->hd).where.t[2] >> 10;
				i = iVar7 * iVar7 + i * i;
				if (i < 0x29) {
					if (i < 0x15) {
						sVar2 = 6000;
						if (9 < i) {
							sVar2 = 0x1324;
						}
					}
					else {
						sVar2 = 4000;
					}
				}
				else {
					sVar2 = 3000;
				}
				cp->thrust = sVar2;
			}
			if (cp->controlType == '\x01') {
				if ((int)player.playerCarId == (uint)(byte)cp->id) {
					i = (int)player.targetCarId;
				}
				else {
					i = -1;
					if ((int)_PLAYER_ARRAY_000d979c[0].playerCarId == (uint)(byte)cp->id) {
						i = (int)_PLAYER_ARRAY_000d979c[0].targetCarId;
					}
				}
				if (i != -1) {
					if (0xbea < ((cp->ap).carCos)->powerRatio) {
						cp->thrust = (short)((int)(car_data[i].ap.carCos)->powerRatio * 0x1333 + 0x800 >>
							0xc);
					}
					iVar7 = (cp->hd).where.t[0] - car_data[i].hd.where.t[0] >> 10;
					i = (cp->hd).where.t[2] - car_data[i].hd.where.t[2] >> 10;
					i = iVar7 * iVar7 + i * i;
					if (i < 0x15) {
						if (i < 7) {
							cp->thrust = (short)(((int)cp->thrust * 0x1a2c) / 7000);
						}
						else {
							cp->thrust = (short)(((int)cp->thrust * 0x1ce8) / 7000);
						}
					}
					else {
						cp->thrust = (short)(((int)cp->thrust * 8000) / 7000);
					}
				}
			}
			if ((cp->hndType == '\0') && ((cp->hd).changingGear != '\0')) {
				cp->thrust = 1;
			}
			goto LAB_00056284;
		}
	}
	cp->thrust = 0;
LAB_00056284:
	cp->lastPad = pad;
	return;*/
}



// decompiled code
// original method signature: 
// void /*$ra*/ InitSkidding()
 // line 2389, offset 0x00056cb8
	/* begin block 1 */
		// Start line: 2390
		// Start offset: 0x00056CB8
		// Variables:
	// 		int i; // $a0
	/* end block 1 */
	// End offset: 0x00056CEC
	// End Line: 2395

	/* begin block 2 */
		// Start line: 8794
	/* end block 2 */
	// End Line: 8795

	/* begin block 3 */
		// Start line: 4778
	/* end block 3 */
	// End Line: 4779

	/* begin block 4 */
		// Start line: 8796
	/* end block 4 */
	// End Line: 8797

/* WARNING: Unknown calling convention yet parameter storage is locked */

void InitSkidding(void)
{
	UNIMPLEMENTED();
	/*
	_PLAYER *p_Var1;
	int iVar2;

	p_Var1 = &player;
	iVar2 = 2;
	do {
		(p_Var1->wheelnoise).sound = -1;
		(p_Var1->wheelnoise).chan = -1;
		(p_Var1->skidding).sound = -1;
		(p_Var1->skidding).chan = -1;
		iVar2 = iVar2 + -1;
		p_Var1 = p_Var1 + 1;
	} while (-1 < iVar2);
	return;*/
}



// decompiled code
// original method signature: 
// void /*$ra*/ TerminateSkidding(int player_id /*$a0*/)
 // line 2397, offset 0x000562ac
	/* begin block 1 */
		// Start line: 6265
	/* end block 1 */
	// End Line: 6266

	/* begin block 2 */
		// Start line: 6288
	/* end block 2 */
	// End Line: 6289

void TerminateSkidding(int player_id)
{
	UNIMPLEMENTED();
	/*
	int channel;

	if ((uint)player_id < 2) {
		channel = (int)(&player)[player_id].skidding.chan;
		if (-1 < channel) {
			StopChannel(channel);
			UnlockChannel((int)(&player)[player_id].skidding.chan);
			(&player)[player_id].skidding.sound = -1;
			(&player)[player_id].skidding.chan = -1;
		}
		channel = (int)(&player)[player_id].wheelnoise.chan;
		if (-1 < channel) {
			StopChannel(channel);
			UnlockChannel((int)(&player)[player_id].wheelnoise.chan);
			(&player)[player_id].wheelnoise.sound = -1;
			(&player)[player_id].wheelnoise.chan = -1;
		}
	}
	return;
	*/
}



// decompiled code
// original method signature: 
// void /*$ra*/ CheckCarEffects(struct _CAR_DATA *cp /*$s2*/, int player_id /*$s3*/)
 // line 2414, offset 0x00056350
	/* begin block 1 */
		// Start line: 2415
		// Start offset: 0x00056350
		// Variables:
	// 		int skidsound; // $s1
	// 		int cnt; // $a0
	// 		int wheels_on_ground; // $s5
	// 		char lay_down_tracks; // $s7
	// 		char desired_skid; // $a1
	// 		char desired_wheel; // $a1

		/* begin block 1.1 */
			// Start line: 2500
			// Start offset: 0x000565E8
			// Variables:
		// 		int pitch; // $v0
		/* end block 1.1 */
		// End offset: 0x00056644
		// End Line: 2504

		/* begin block 1.2 */
			// Start line: 2507
			// Start offset: 0x00056660
			// Variables:
		// 		int wnse; // $a0
		/* end block 1.2 */
		// End offset: 0x000566A8
		// End Line: 2510

		/* begin block 1.3 */
			// Start line: 2533
			// Start offset: 0x000567A8
			// Variables:
		// 		int pitch; // $t0
		/* end block 1.3 */
		// End offset: 0x00056810
		// End Line: 2537

		/* begin block 1.4 */
			// Start line: 2546
			// Start offset: 0x00056840
		/* end block 1.4 */
		// End offset: 0x00056868
		// End Line: 2550
	/* end block 1 */
	// End offset: 0x000568AC
	// End Line: 2560

	/* begin block 2 */
		// Start line: 6322
	/* end block 2 */
	// End Line: 6323

	/* begin block 3 */
		// Start line: 6325
	/* end block 3 */
	// End Line: 6326

void CheckCarEffects(_CAR_DATA *cp, int player_id)
{
	UNIMPLEMENTED();
	/*
	uchar uVar1;
	bool bVar2;
	bool bVar3;
	int channel;
	uint uVar4;
	WHEEL *pWVar5;
	int iVar6;
	uint uVar7;
	int sample;
	char cVar8;

	bVar2 = false;
	bVar3 = false;
	uVar1 = cp->controlType;
	if (((uVar1 != '\x01') && (uVar1 != '\x04')) && (uVar1 != '\a')) {
		TerminateSkidding(player_id);
		return;
	}
	jump_debris(cp);
	pWVar5 = (cp->hd).wheel;
	sample = 3;
	do {
		if (pWVar5->susCompression != '\0') {
			bVar2 = true;
		}
		sample = sample + -1;
		pWVar5 = pWVar5 + 1;
	} while (-1 < sample);
	sample = 0;
	if (bVar2) {
		if (cp->wheelspin == '\0') {
			channel = (cp->hd).rear_vel;
			if (channel < 0) {
				channel = -channel;
			}
			if (channel < 0x2b5d) goto LAB_00056474;
		}
		rear_only = '\x01';
		bVar3 = true;
		if (cp->wheelspin == '\0') {
			sample = (cp->hd).rear_vel;
			if (sample < 0) {
				sample = -sample;
			}
			sample = (sample + -0x2b5c) / 2 + 1;
			if (sample < 0x32c9) goto LAB_00056474;
		}
		sample = 13000;
	}
LAB_00056474:
	channel = (cp->hd).front_vel;
	if (channel < 0) {
		channel = -channel;
	}
	if (0x2b5c < channel) {
		rear_only = '\0';
		bVar3 = true;
	}
	cVar8 = -1;
	if (((sample != 0) &&
		((((cp->hd).wheel[1].surface & 0x80) == 0 || (((cp->hd).wheel[3].surface & 0x80) == 0)))) &&
		(cVar8 = '\v', gWeather - 1U < 2)) {
		cVar8 = -1;
	}
	if (cVar8 == (&player)[player_id].skidding.sound) {
	LAB_000565b4:
		if ((-1 < (&player)[player_id].skidding.sound) &&
			(channel = (int)(&player)[player_id].skidding.chan, -1 < channel)) {
			iVar6 = (sample + -10000) * 3;
			if (iVar6 < 0) {
				iVar6 = iVar6 + 3;
			}
			SetChannelPosition3(channel, (VECTOR *)(cp->hd).where.t, (long *)(cp->st + 0x1c),
				(iVar6 >> 2) + -5000, (sample * 0x400) / 13000 + 0xc00 + player_id * 8, 0);
		}
	}
	else {
		channel = (int)(&player)[player_id].skidding.chan;
		(&player)[player_id].skidding.sound = cVar8;
		if (-1 < channel) {
			StopChannel(channel);
			UnlockChannel((int)(&player)[player_id].skidding.chan);
			(&player)[player_id].skidding.chan = -1;
		}
		channel = (int)(&player)[player_id].skidding.sound;
		if (-1 < channel) {
			channel = StartSound(-1, 1, channel, sample + -10000, 0x1000);
			(&player)[player_id].skidding.chan = (char)channel;
			LockChannel((int)(char)channel);
			if ((1 < NumPlayers) && (NoPlayerControl == 0)) {
				SetPlayerOwnsChannel((int)(&player)[player_id].skidding.chan, (char)player_id);
			}
			goto LAB_000565b4;
		}
	}
	sample = -1;
	if ((bVar2) && (10 < (cp->hd).speed)) {
		uVar4 = (uint)(cp->hd).wheel[3].surface & 7;
		uVar7 = (uint)(cp->hd).wheel[1].surface & 7;
		if (uVar4 < uVar7) {
			uVar4 = uVar7;
		}
		sample = 0xd;
		if ((1 < gWeather - 1U) && (sample = -1, uVar4 != 0)) {
			sample = uVar4 + 0xc;
		}
	}
	if (sample != (int)(&player)[player_id].wheelnoise.sound) {
		channel = (int)(&player)[player_id].wheelnoise.chan;
		(&player)[player_id].wheelnoise.sound = (char)sample;
		if (-1 < channel) {
			StopChannel(channel);
			UnlockChannel((int)(&player)[player_id].wheelnoise.chan);
			(&player)[player_id].wheelnoise.chan = -1;
		}
		sample = (int)(&player)[player_id].wheelnoise.sound;
		if (sample < 0) goto LAB_00056814;
		sample = StartSound(-1, 1, sample, -200, 0x1000);
		(&player)[player_id].wheelnoise.chan = (char)sample;
		LockChannel((int)(char)sample);
		if ((1 < NumPlayers) && (NoPlayerControl == 0)) {
			SetPlayerOwnsChannel((int)(&player)[player_id].wheelnoise.chan, (char)player_id);
		}
	}
	if ((-1 < (&player)[player_id].wheelnoise.sound) &&
		(sample = (int)(&player)[player_id].wheelnoise.chan, -1 < sample)) {
		iVar6 = (cp->hd).speed;
		channel = iVar6 * 0x1b;
		if (0xe00 < channel) {
			channel = 0xe00;
		}
		if (100 < iVar6) {
			iVar6 = 100;
		}
		SetChannelPosition3(sample, (VECTOR *)(cp->hd).where.t, (long *)(cp->st + 0x1c),
			iVar6 * 0x32 + -10000, channel + player_id * 8, 0);
	}
LAB_00056814:
	(&player)[player_id].onGrass = '\0';
	GetTyreTrackPositions(cp, player_id);
	if (bVar3) {
		continuous_track = last_track_state == (uint)(byte)rear_only;
		AddTyreTrack(player_id << 1, (uint)(player_id < 2), player_id);
		AddTyreTrack(player_id << 1 | 1, (uint)(player_id < 2), player_id);
		last_track_state = ZEXT14((byte)rear_only);
	}
	else {
		last_track_state = -1;
	}
	SetTyreTrackOldPositions(player_id);
	return;*/
}



// decompiled code
// original method signature: 
// void /*$ra*/ jump_debris(struct _CAR_DATA *cp /*$s1*/)
 // line 2575, offset 0x000568d8
	/* begin block 1 */
		// Start line: 2576
		// Start offset: 0x000568D8
		// Variables:
	// 		int count; // $a1

		/* begin block 1.1 */
			// Start line: 2599
			// Start offset: 0x00056964
			// Variables:
		// 		struct VECTOR position; // stack offset -48
		// 		struct VECTOR velocity; // stack offset -32
		/* end block 1.1 */
		// End offset: 0x000569F8
		// End Line: 2603
	/* end block 1 */
	// End offset: 0x000569F8
	// End Line: 2604

	/* begin block 2 */
		// Start line: 6655
	/* end block 2 */
	// End Line: 6656

	/* begin block 3 */
		// Start line: 6657
	/* end block 3 */
	// End Line: 6658

void jump_debris(_CAR_DATA *cp)
{
	UNIMPLEMENTED();
	/*
	char cVar1;
	byte bVar2;
	uint uVar3;
	WHEEL *pWVar4;
	int iVar5;
	VECTOR local_30;
	VECTOR local_20;

	iVar5 = 0;
	pWVar4 = (cp->hd).wheel;
	do {
		iVar5 = iVar5 + 1;
		if (pWVar4->susCompression != '\0') {
			DebrisTimer = '\0';
			cp->wasOnGround = '\x01';
			return;
		}
		pWVar4 = pWVar4 + 1;
	} while (iVar5 < 4);
	if (cp->wasOnGround == '\x01') {
		cp->wasOnGround = '\0';
		DebrisTimer = 'P';
		nose_down(cp);
	}
	cVar1 = DebrisTimer + -1;
	if ((DebrisTimer != '\0') && (bVar2 = DebrisTimer - 1, DebrisTimer = cVar1, bVar2 < 0x4b)) {
		memset(&local_20, 0, 0x10);
		uVar3 = rand();
		local_20.vx = (cp->hd).where.t[0] + ((uVar3 & 0x1ff) - 0x100);
		local_20.vy = 200 - (cp->hd).where.t[1];
		uVar3 = rand();
		local_30.vz = (cp->hd).where.t[2] + ((uVar3 & 0x1ff) - 0x100);
		local_30.vx = local_20.vx;
		local_30.vy = local_20.vy;
		local_30.pad = local_20.pad;
		local_20.vz = local_30.vz;
		memset(&local_20, 0, 0x10);
		Setup_Debris(&local_30, &local_20, 5, 0xb);
	}
	return;
	*/
}



// decompiled code
// original method signature: 
// void /*$ra*/ nose_down(struct _CAR_DATA *cp /*$a0*/)
 // line 2607, offset 0x00056a74
	/* begin block 1 */
		// Start line: 7459
	/* end block 1 */
	// End Line: 7460

	/* begin block 2 */
		// Start line: 7461
	/* end block 2 */
	// End Line: 7462

void nose_down(_CAR_DATA *cp)
{
	UNIMPLEMENTED();
	/*
	short sVar1;
	short sVar2;

	sVar1 = (cp->hd).where.m[3];
	*(int *)(cp->st + 0x28) = *(int *)(cp->st + 0x28) + (int)(cp->hd).where.m[0] * 0x32;
	sVar2 = (cp->hd).where.m[6];
	*(int *)(cp->st + 0x2c) = *(int *)(cp->st + 0x2c) + (int)sVar1 * 0x32;
	*(int *)(cp->st + 0x30) = *(int *)(cp->st + 0x30) + (int)sVar2 * 0x32;
	return;
	*/
}



// decompiled code
// original method signature: 
// int /*$ra*/ GetPlayerId(struct _CAR_DATA *cp /*$a0*/)
 // line 2664, offset 0x00056cec
	/* begin block 1 */
		// Start line: 2665
		// Start offset: 0x00056CEC
		// Variables:
	// 		int i; // $a1
	// 		int p_id; // $a3
	/* end block 1 */
	// End offset: 0x00056D54
	// End Line: 2669

	/* begin block 2 */
		// Start line: 9334
	/* end block 2 */
	// End Line: 9335

	/* begin block 3 */
		// Start line: 9345
	/* end block 3 */
	// End Line: 9346

int GetPlayerId(_CAR_DATA *cp)
{
	UNIMPLEMENTED();
	return 0;
	/*
	char *pcVar1;
	int iVar2;
	_PLAYER *p_Var3;
	int iVar4;

	iVar2 = 0;
	p_Var3 = &player;
	while ((iVar4 = -1, iVar2 < 3 &&
		(pcVar1 = &p_Var3->playerCarId, p_Var3 = p_Var3 + 1, iVar4 = iVar2,
			car_data + *pcVar1 != cp))) {
		iVar2 = iVar2 + 1;
	}
	return iVar4;*/
}