setting 3d array
adding scheduling non-preemptive
Merge branch 'master' of https://github.com/rtosMasterTec/collisionAvoidanceProject
modifying function to be schedulable
missed to add the actual scheduler files