Fix wait condition
Fix I2C MCP23017 get test