Faster stack, there is no point to set a error flasg if you didn't check that
Remove unused variable
Move stack code to main file
Remove unwanted files
Better way to read sensors
Remove IOpointer and byte