Node Publish succesful cone triangulations
This MR will allow the motionparallaxnode
to publish all successful triangulations as a OpticalConeTriangulation
message every time a frame is received.
depends on: https://gitlab.com/KSU_EVT/autonomous-software/voltron_msgs/-/merge_requests/1