New move function in RedKip

Rewrote and simplified it, reduced code bloat.
Obstacle avoidance mostly done, still working on it a bit.