Angle Finder

I got a working calculator that can get the angle of the elbow, wrist and shoulder! I used a lot of geometery like acos and atan2 from the py math module.

The math was hard so I had to youtube it and implement in this. Just to make sure my angle calculator was actually reading the correct measurements, I identified the angle, so it was reading it correctly even if I rotate myself.