Fix wait allocation cleanup (#770)
Fix wait allocation cleanup (#770)

* Add fix wait.c init/fini allocation on error
* Add test for the fix
* Remove unit tests

Signed-off-by: Jorge Perez <afab1c53f90df8000fd0bd323d84f98f2c232f36@ekumenlabs.com>
ros2/rcl,ros2/rcl