Added code to make PositioningSubsystem more efficient. DirectionVector.add() no longer takes a DirectionVector. It now takes double angle, double magnitude. This reduces the number of new objects created and makes the PositioningSubsystem use less memory.