Modify optimization for 4 DoF transformations?

[murrdpirate]

In my problem, the two point clouds are transformed by only x,y,z position and yaw angle. Would it make sense to modify FGR to enforce this constraint? Should better accuracy/speed be expected?

It was certainly a benefit for RANSAC, and I'm curious if I can get even better results with FGR.