ExcelResearchDroneWork/Vector.java~ at master · craigLombardo/ExcelResearchDroneWork · GitHub

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
public class Vector{

  private Double xVal, yVal;

  public Vector(Double x, Double y){
    xVal = x;
    yVal = y;
  }

  public Double x(){
    return xVal;
  }

  public Double y(){
    return yVal;
  }

  public void flip(){
    xVal = -xVal;
    yVal = -yVal;
  }

  public void makeUnitVector(){
    double mag = Math.sqrt(Math.pow(xVal,2)+Math.pow(yVal,2));
    xVal /= mag;
    yVal /= mag;
  }

  public double getMag(){
    return Math.sqrt(Math.pow(xVal,2)+Math.pow(yVal,2));
  }

  public double getAngle(){
    return 180.0-Math.toDegrees(Math.atan2(-yVal,-xVal));
  }

  public void mulFactor(double val){
    xVal *= val;
    yVal *= val;
  }

  public void print(){
    System.out.println("x comp: " + xVal);
    System.out.println("y comp: " + yVal);
  }

  public void makeOrthogonal(double uAngle, double vAngle){
    double tmpx = xVal;
    xVal = yVal;
    yVal = tmpx;

    double newVAngle = vAngle;
    double newUAngle = uAngle;

    if(vAngle < 90 && uAngle > 270) newVAngle += 360;
    else if(uAngle < 90 && vAngle > 270) newUAngle += 360;

    double delt = 0.15;
    double um = 2.0;
    if(newVAngle <= newUAngle){
      if(Math.abs(xVal) < 0.1) xVal = yVal >= 0 ? um : -um;
      else xVal = (delt)*xVal;
      yVal = -yVal;
    }
    else{
      xVal = -xVal;
      if(Math.abs(yVal) < 0.1) yVal = xVal >= 0 ? um : -um;
      else yVal = (delt)*yVal;
      //System.out.println("here");
    }
  }

}