[CG solver] assert x does not contain nan

[hxu296]

trafficstars

Currently, CG will silently return x even if it contains nan, which may hide numeric instability issue.

[wang-chen]

You can also use this function to check: https://pypose.org/docs/main/generated/pypose.hasnan/?highlight=nan#pypose.hasnan