Preparing code for the raspberry pi, not tested yed, only coding and a little c++ recalling things ;)"