migrate matrixtools to glm

Change-Id: Ibd558f5d85f78e52fc6a73ba14acf2ea68ce8a37
replaced B2IVector with glm::vec2

Change-Id: Id89699358ec0a831184b4180a1e0c34c5ce2d9d0