fix assertion so it doesn't fail for nans
do the assertion more efficiently
add a test for nans
Merge pull request #6 from Futrell/master

Smarter assertion in cam02ucs