Fix I2C communcation issues with AS5600

[calebchalmers]

Sometimes after flashing code to the Dev Board, the firmware gets stuck on trying to communicate with I2C and doesn't recover until the robot is restarted. We should do more testing to get to the bottom of that issue and fix it. This will probably mean adding more careful checks to the AS5600 driver to be sure everything is being initialized properly and at the right time.