rbtree: copy the implementation from the Linux tree

This is not really Linux specific, just a neat implementation
used by kvmtool.

Signed-off-by: Andre Przywara <andre.przywara@arm.com>