Fix the same issue with https://github.com/tork-a/rtmros_nextage/issues/25

Applying the same patch (https://github.com/tork-a/rtmros_nextage/commit/d4268d81ec14a514bb4b3b52614c81e708dd1ecc#diff-20257dd6ad60c0892cfb122c37a8f2ba)