Fixing math errors and beginning attempts to get working for EMC01.
Please see the feature/3dprinting branch if you're trying to 3d print.