X & Z axis are ok.
Constraint for X & Z are ok.

Need to check Y axis computation model block.

Heading is ok.
claw is ok.