Some additions : Multiplying mastrix by vector, some fixies in vector opIndex, revriting in new style some pieces of rigidbodu