Add hardware and system checks

[calebchalmers]

Ideas:

• Beep different notes for each motor online
• Check ref serial connection
• Check encoder communication