correct some code
run() with do-while instead of while for executing run() without threads
add correct some register addresses for sensors