Update bma222.c