Add more serialization for eigen types and collision types

Add more serialization for eigen types and collision types #3665