Add testing functionality with PyTest

[JnliaH]

This goes hand-in-hand with simplifying the function organization. Once functions are separated and easier to test directly, set up PyTest and Github workflows to automate testing each push.