Signed-off-by: Kevin O'Connor <kevin@koconnor.net>
Move the trilateration algorithm to mathutil.py. It may be useful outside of delta kinematics, and it complicates the delta code. Signed-off-by: Kevin O'Connor <kevin@koconnor.net>
Add a new python file (mathutil.py) and move the coordinate_descent() code to it. Signed-off-by: Kevin O'Connor <kevin@koconnor.net>