Updates for roam

* added initial roam code : doesnt work yet
* added more vector math functions