Merge pull request #1 from dima6120/noise

added mathUtils
Review fixes
Fixed touch sensor incorrect work on some directions
Fixed touch sensor stucking in wall
conflicts are resolved