Fixed message queue issue with pointers
Merge branch 'devel'