Finished findAngle() and added Function class