RP-248 initial commit
RP-248 merge into one message
RP-248 Update maintainer info
RP-248 refactor to include control loop frequency in diagnostics