Remove transient local, improve tests

• Adds matching
• Add API to test nodes
• Use matching in tests
• Remove TRANSIENT_LOCAL from topics
• Shift hacky initial trajectory publish in MotionTestingNode into match() rather than being upon construction