Messages rate stuck at 330 Hz


Im running the px4.launch file in mavros, and checking the rate of custom messages. Although they were set to 400 Hz in mavlink_main.cpp. The messages are throttled at 330 Hz. Im using pixhawk 6x and an ethernet connection. Is their any parameters I need to change to make the messages reach 400 Hz. I came across someone mentioning a similar problem when SYS_FMU_TASK is set to 0, but cant seem to find the parameter now to change it (probably it was depreciated).

Any ideas?