4 ms·

What about using an actual vector library like Eigen? I wouldn’t dream of reimplementing basic maths like that.