Update octomat.hpp