Merge pull request #46 from SJossy/master

Proposed changes
Merge pull request #50 from SJossy/master

Major mission code redesign
Merge pull request #51 from SJossy/master

update safepos
mission orginization
Merge pull request #5 from f3cuk/Testbranch

Testbranch sync