utils: calculate joint speed from time and distance
Simple graph
Graph Angles