MPU 6050 DMP Empty Fifo

I think problem is with DMP. From registers i can get all measurements data, but with DMP i cant get any data from fifo it is empty all the time. This software works with MPU9250 without any problems but with MPU6500 i cant get data from fifo.

 err_code = dmp_enable_feature(DMP_FEATURE_6X_LP_QUAT |  DMP_FEATURE_SEND_RAW_ACCEL | DMP_FEATURE_SEND_CAL_GYRO |

            DMP_FEATURE_GYRO_CAL);

    SEGGER_RTT_printf(0," dmp_enable_feature %d\n",err_code);

    err_code = dmp_set_fifo_rate(DEFAULT_MPU_HZ);

    SEGGER_RTT_printf(0," dmp_set_fifo_rate %d\n",err_code);
    err_code = mpu_set_dmp_state(1);

    SEGGER_RTT_printf(0," mpu_set_dmp_state %d\n",err_code);

to read fifo im using function below.
dmp_read_fifo(&gyroD[0],&acceD[0],&quatD[0],&timestamp,&sensors, &moreData) Maybe there is some restriction on MPU6500. Do you have any suggestion why it works on MPU9250 and doesnt works on MPU6500. In both cases im using SPI.