cone update

* adding cone collision functionality
* TODO cone-to-cone collision