Improve naming of cukfmath.h functions; added error text to assertions
Simplified matrix subtraction
Merge pull request #25 from sfwa/bendyer-cukf-cleanup

Cleaning up the C66x UKF implementation