Added some math-functions and removed old touchscreen fix