paper: Team 341 Vision System Code

[Ziv]

Originally Posted by sebflippers

Thanks for the code. I believe lines 322-334 [snipped] could be replaced with

private double boundAngle0to360Degrees(double angle)
    {
        return(abs(angle)%360.0);
    }

Consider the angle -90. Daisy's code returns 270, but yours returns 90. I think you're looking for something more like this:

private double boundAngle0to360Degrees(double angle)
    {
        double ret = abs(angle)%360.0;
        if(angle < 0.0)
        {
            ret = -ret;
        }
        return(ret);
    }