fix(bhi160): Call bhy_mapping_matrix_set twice for the first time

Due to a known issue (#133) the first call to bhy_mapping_matrix_set
can fail. This is a quick fix.