Added distance.cpp for the SphericalDistanceDeterminationAlgorithm

[tan7271]

Description

-Changed a few header files (namely attitude-utils) to add midpoint functions for Vec2 and Vec3
-Line 49 of Distance.cpp python code was center = np.linalg.solve(A, y), which i used the inverse matrix function to solve for instead.
(Probably contains a few errors, if you see them feel free to point out)

Artifacts for PR #4 (DO NOT CHANGE)

• Coverage Artifact
• Doxygen Artifact

[nguy8tri]

Great job, just some changes before we test!

[nguy8tri]

Great job, just a few more styling issues!

[nguy8tri]

Just merged from main into this branch (took about an hour, you're welcome). Here's what else I've done:

1. Took out some unnecessary code (e.g. A function who only calls another function)
2. Added Documentation to Undocumented Stuff
3. Placed your files in the appropriate folder (src/distance and test/distance)
4. I also did some light debugging of your code, and it turns out the math behind some of your original code was wrong, so I fixed that, and your base case test does work now (hooray!).

I'm not sure if you saw the new message, but there are quite a few changes that have occurred with the code base. This is part of a modern refractor to leverage CI/CD in our project.

• A detailed documentation of the new changes can be viewed here
• Our meeting on 10/14 is recorded, in which I go over all these changes. You can access the recording here)
  These changes automate many parts of the coding process. This includes the PRs that you publish, which have automated checks. The bottom line is that if your checks are not passing, then you need to fix it before I review it (you can verify if it will do so locally by simply specifying make). Luckily, I made sure of that to begin with, so you're starting off with them passing! They will update every time you make a new commit.