The algorithm is tested separately:
https://onlinegdb.com/BJiL_9bIQ
I'm sure there are improvements to be made but the current implementation should be solid.
Kernel + updated drm drivers have been tested on a Broadwell laptop (where BIOS does reserve memory properly)
From pci_early_quirks() I did some calls to phys_avail_reserve() with various base and size parameters and confirmed in verbose boot that the ranges had been excluded from the phys avail list.
A patched kernel can be built from here: https://github.com/FreeBSDDesktop/freebsd-base/tree/intelstolen-physavail
drm drivers must be rebuilt against the patched kernel source: https://github.com/FreeBSDDesktop/kms-drm/tree/drm-v4.16
It will add a log entry similar to this
[drm] Got stolen memory base 0xcd800000, size 0x2000000
Without these bits in the kernel, stolen memory is set to 0 and this causes panics during kldload on certain Intel hardware. We have not been able to reproduce the panic when using this patch (together with https://reviews.freebsd.org/D17431)