[PX4 v1.16.0] No ESC Telemetry with AM32 (DShot300, Pixhawk 6C)

I’m testing ESC telemetry with PX4 and can’t get it working.

Current status:

  • Motors run fine with DShot300.

  • Telemetry does not work in PX4.

  • I am getting the follwing responces in MAVLink console

    dshot esc_info -m 1
    ERROR [dshot] Packet length mismatch (64 != 15)
    nsh> dshot esc_info -m 1
    ERROR [dshot] Packet length mismatch (40 != 15)

    First is with both esc boards connected the other one is with only one.

    I cant understand what am I missing out. Any help is very appreciated.