Working proof of concept, still has issues with axes and angles.
ignore photos