Added triangulation to allow faster direct kinematic calculations for our robots
Added triangulation to allow faster direct kinematic calculations for our robots

Mantella/Mantella,Mantella/Mantella,SebastianNiemann/Mantella,Mantella/Mantella,SebastianNiemann/Mantella,SebastianNiemann/Mantella