So next step done-
remark: Jittering caused by wheeled shelf. Next will be inverse kinematics. Planar at least.