manually cleared lines for substepping systems
minor corrections
corrected line drawing scale mainly
util funcs in math
finished initial collision avoidance!
may be even enough considering static environment +small dynamic obstacles usage