* Added test-node package

Co-authored-by: Bence Magyar <bence.magyar.robotics@gmail.com>