Adding export of trajectory
Working export with openHubo names, need hubo-ach name conversion
Added hubo-ach mapping functions
Added trajectory export example
Added pickling support for data logging and verified that full-contact case is accurate
Refactored contact eval