scara algorithm