Code cleanup and few features added

This is just some cleanup of ATLASPix code after the merge from 6-07-18. Tested on hardware and works fine. There is also some commits from sometime ago which were somehow not in the previous merge. These are trivial change and bug fixes. Peary code was not touched.