Add Xenomai support (#6)

This is an updated version of the patch posted in #6.