- Add GYRO_CONFIG0/ACCEL_CONFIG0 register setup in imu_read_direct() to fix gyro always returning -32768 - Increase sensor startup delay from 2ms to 80ms for reliable first read - Put IMU back to sleep after msp? read to save power - Fix piezo frequency table: swap freq 0/1 values, remove unused freq 5 Co-Authored-By: Claude Opus 4.6 <noreply@anthropic.com>