more utility functions

norm
inverse_norm
utility
isGoal
isWall