Almost done AngleCal, Side Cal, and VectorAdd

Need to implement Error handling
1
Revert "1"

This reverts commit 3c7d5b03f6233b07aa42b850ddb0aa8e486bf4f6.