SubDyn: direction cosine matrix has no checks

**Bug description**
The direction cosine matrix input to SubDyn currently has no checks to ensure it is valid.

**Proposed solutions**
1. Remove the cosine matrix
2. add checks on the input and set to closest (rescale, convert to euler angle, then back)

