implement VERIFY in a function so it doesn't get compiled thousands of times.
implement VERIFY in a function so it doesn't get compiled thousands of times.

robustrobotics/eigen,robustrobotics/eigen,robustrobotics/eigen,robustrobotics/eigen