adds (self-)collision checking support and implements it for Korus