Ready to fly

printing function improved, saving to a file included, ready to do a
test flight to get some data.