Adds vel3d test
Fixes registration errors
Merge pull request #1547 from lukecampbell/1390reg-r2

OOIION-1390 Fixes Registration Problem R2