Fix exception - invalid array index

Dear Marco,

Please let me know if this is the intended kind of output! Otherwise, the type of the variable should be doublereal instead of Vec3.