Add diagnostic data to all nodes

[wheitman]

Each node should publish a DiagnosticStatus message. A separate "watchdog" node should:

1. Aggregate these messages into a DiagnosticArray and publish this
2. Inspect each node's status and send an appropriate global status: "Ready," "Active," "Not Ready," "Critical Fault," etc.