SafeOrient - SafeControllerLook.java

package net.isageek.joethornton.Orientation;

import net.minecraft.server.ControllerLook;
import net.minecraft.server.Entity;
import net.minecraft.server.EntityLiving;
import net.minecraft.server.MathHelper;

public class SafeControllerLook extends ControllerLook {

    // Hiding variable a from ControllerLook
    private SafePlayer a;
    private float b;
    private float c;
    private boolean d = false;
    private double e;
    private double f;
    private double g;

    public SafeControllerLook(SafePlayer safeplayer) {
        super(safeplayer);
        this.a = safeplayer;
    }

    @Override
    public void a(Entity entity, float f, float f1) {
        this.e = entity.locX;
        if (entity instanceof EntityLiving) {
            this.f = entity.locY + (double) entity.getHeadHeight();
        } else {
            this.f = (entity.boundingBox.b + entity.boundingBox.e) / 2.0D;
        }

        this.g = entity.locZ;
        this.b = f;
        this.c = f1;
        this.d = true;
    }

    @Override
    public void a(double d0, double d1, double d2, float f, float f1) {
        this.e = d0;
        this.f = d1;
        this.g = d2;
        this.b = f;
        this.c = f1;
        this.d = true;
    }

    @Override
    public void a() {
        this.a.pitch = 0.0F;
        if (this.d) {
            this.d = false;
            double d0 = this.e - this.a.locX;
            double d1 = this.f - (this.a.locY + (double) this.a.getHeadHeight());
            double d2 = this.g - this.a.locZ;
            double d3 = (double) MathHelper.sqrt(d0 * d0 + d2 * d2);
            float f = (float) (Math.atan2(d2, d0) * 180.0D / 3.1415927410125732D) - 90.0F;
            float f1 = (float) (-(Math.atan2(d1, d3) * 180.0D / 3.1415927410125732D));

            this.a.setPitch(this.a(this.a.pitch, f1, this.c));
            this.a.X = this.a(this.a.X, f, this.b);
        } else {
            this.a.X = this.a(this.a.X, this.a.V, 10.0F);
        }

        float f2;

        for (f2 = this.a.X - this.a.V; f2 < -180.0F; f2 += 360.0F) {
            ;
        }

        while (f2 >= 180.0F) {
            f2 -= 360.0F;
        }

        if (!this.a.al().e()) {
            if (f2 < -75.0F) {
                this.a.X = this.a.V - 75.0F;
            }

            if (f2 > 75.0F) {
                this.a.X = this.a.V + 75.0F;
            }
        }
    }

    private float a(float f, float f1, float f2) {
        float f3;

        for (f3 = f1 - f; f3 < -180.0F; f3 += 360.0F) {
            ;
        }

        while (f3 >= 180.0F) {
            f3 -= 360.0F;
        }

        if (f3 > f2) {
            f3 = f2;
        }

        if (f3 < -f2) {
            f3 = -f2;
        }

        return f + f3;
    }
}