This PR templates a function in the telem interface to allow us to pack and push messages onto the circular buffer in one line, removing the amount of reused code.
I will do the embedded tests I could not run tonight on Sunday, and then the commented code can be removed and this can be merged
All tests passed. There was some funkiness with calling the templated function outside of the class when I was testing, but it works as is currently implemented.
Merging this
This PR templates a function in the telem interface to allow us to pack and push messages onto the circular buffer in one line, removing the amount of reused code.
I will do the embedded tests I could not run tonight on Sunday, and then the commented code can be removed and this can be merged
closes #40