Realtime obsticle avoidance coded, needs testing. Position determination neesd coding