Dangerous Prototypes Open Source Hardware

int bp_bin_i2c_write_read_bulk(BP *bp, const unsigned char *write_buf, size_t write_count,
                               unsigned char *read_buf, size_t read_count)
{
    __debug__("WRITE %u, READ %un", write_count, read_count);
    _bp_check_state(bp, BP_STATE_BIN_I2C);
    
    unsigned char wbuf[5] = { BP_BIN_I2C_BULK_RW, write_count >> 8 & 0xFF, write_count & 0xFF,
                              read_count >> 8 & 0xFF, read_count & 0xFF };
    if (bp_write(bp, wbuf, 5) != BP_SUCCESS)
        return BP_FAILURE;
    if (write_count > 0 && bp_write(bp, write_buf, write_count) != BP_SUCCESS)
        return BP_FAILURE;
    if (bp_read(bp, wbuf, 1) != BP_SUCCESS)
        return BP_FAILURE;
    if (wbuf[0] == 0)
        return BP_FAILURE;
    if (read_count > 0 && bp_read(bp, read_buf, read_count) != BP_SUCCESS)
        return BP_FAILURE;
    
    return BP_SUCCESS;
}

    const unsigned char wbuf[1] = { (I2C1_ADDRESS << 1) | 1 };
    if (bp_bin_i2c_write_read_bulk(bp, wbuf, 1, (unsigned char*)&packet, sizeof(packet)) != BP_SUCCESS)
    {
        printf("Error reading data packet.n");
        return BP_FAILURE;
    }
    
    return BP_SUCCESS;