Better 3D Vector Additions

Increase the functionality and the way the 3D vector addition function
behaved. I also added comments and revised the functions a bit.