rearranged software files to proper python package

basic path planning features
a lot of tests added