Several change to make two steps but without StateMachine
Added rx 1.05 radians  in rgbd transform
Changes focal to 585