Add ar_tap_kins and gantry_xyzcs_kins