aboutsummaryrefslogtreecommitdiff
path: root/Minecraft.World/MoveControl.cpp
blob: 02b5a9e0e52646787fe4e7ed754d1bf1ca0c5ef8 (plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
#include "stdafx.h"
#include "net.minecraft.world.entity.h"
#include "net.minecraft.world.entity.ai.attributes.h"
#include "net.minecraft.world.entity.ai.control.h"
#include "net.minecraft.world.entity.monster.h"
#include "net.minecraft.world.phys.h"
#include "MoveControl.h"

const float MoveControl::MIN_SPEED = 0.0005f;
const float MoveControl::MIN_SPEED_SQR = MIN_SPEED * MIN_SPEED;

MoveControl::MoveControl(Mob *mob)
{
	this->mob = mob;
	wantedX = mob->x;
	wantedY = mob->y;
	wantedZ = mob->z;

	speedModifier = 0.0;

	_hasWanted = false;
}

bool MoveControl::hasWanted()
{
	return _hasWanted;
}

double MoveControl::getSpeedModifier()
{
	return speedModifier;
}

void MoveControl::setWantedPosition(double x, double y, double z, double speedModifier)
{
	wantedX = x;
	wantedY = y;
	wantedZ = z;
	this->speedModifier = speedModifier;
	_hasWanted = true;
}

void MoveControl::tick()
{
	mob->setYya(0);
	if (!_hasWanted) return;
	_hasWanted = false;

	int yFloor = floor(mob->bb->y0 + .5f);

	double xd = wantedX - mob->x;
	double zd = wantedZ - mob->z;
	double yd = wantedY - yFloor;
	double dd = xd * xd + yd * yd + zd * zd;
	if (dd < MIN_SPEED_SQR) return;

	float yRotD = (float) (atan2(zd, xd) * 180 / PI) - 90;

	mob->yRot = rotlerp(mob->yRot, yRotD, MAX_TURN);
	mob->setSpeed((float) (speedModifier * mob->getAttribute(SharedMonsterAttributes::MOVEMENT_SPEED)->getValue()));

	if (yd > 0 && xd * xd + zd * zd < 1) mob->getJumpControl()->jump();
}

float MoveControl::rotlerp(float a, float b, float max)
{
	float diff = Mth::wrapDegrees(b - a);
	if (diff > max)
	{
		diff = max;
	}
	if (diff < -max)
	{
		diff = -max;
	}
	return a + diff;
}