Fixed robot modell
Removed unused sparse help functions (+ tests)