Added some geometry tools