Diag_IMUTest() is now a proper test.  Quickly diagnoses disconnected finger sensors, communication quality, and interrupt operation.

Signed-off-by: Anthony Clay <anthony.clay@zarthcode.com>