More migration of chipmunk source

Mostly implemented the cpVect support.