Programming is nice but for geometry you want a constraint solver.