Add some math utils