Worked on (vector) math code

Worked on (vector) math code