pios_queue: add ChibiOS implementation