Port critical portion to C / C++