added some vector functions, some collision testing