Get basic CJL.ScatterAlignPose3 functional on standardized code

[dehann]

TAC

get SAP3 functional as simple point to point alignment.

Notes

• separate issue to upgrade ScatterAlignPose3 to also use point normals.

[dehann]

[dehann]

Wip:

• ScatterAlignPose3 and ArrayPartition fixes #874

[dehann]

Common rigid transform function for _PCL and ScatterAlign, working torwards Pose3:

• Common transform for ScatterAlign and _PCL , Pose3 #878

[dehann]

Further work for ScatterAlignPose3:

• better standz. ScatterAlign as PosePose residual (Pose3) #879

[dehann]

Just adding reference alignment solution from completeness:

• http://www.open3d.org/docs/release/tutorial/t_pipelines/t_icp_registration.html?highlight=icp#Multi-Scale-ICP-Example
• http://www.open3d.org/docs/release/tutorial/t_pipelines/t_icp_registration.html?highlight=icp#Point-To-Point-ICP-Registration

[dehann]

To speed things up (and after finding), I'm consolidating the simpleICP.jl implementation. This is the defacto standard. One trick not included in ScatterAlign is to setup the cost function against path normals around each point.

Here is the first piece:

• consolidating simpleICP with PCL types #885

and here is what the code does with the two pointclouds from above: