Updating code to latest version of Arduino, replacing old driver libraries, removing uncessary delays, profiling code is present for the time being.