Implementing performance critical code in C++