162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 262306a36Sopenharmony_ci#include <unistd.h> 362306a36Sopenharmony_ci#include <stdbool.h> 462306a36Sopenharmony_ci#include <errno.h> 562306a36Sopenharmony_ci#include <linux/kernel.h> 662306a36Sopenharmony_ci#include <internal/lib.h> 762306a36Sopenharmony_ci 862306a36Sopenharmony_ciunsigned int page_size; 962306a36Sopenharmony_ci 1062306a36Sopenharmony_cistatic ssize_t ion(bool is_read, int fd, void *buf, size_t n) 1162306a36Sopenharmony_ci{ 1262306a36Sopenharmony_ci void *buf_start = buf; 1362306a36Sopenharmony_ci size_t left = n; 1462306a36Sopenharmony_ci 1562306a36Sopenharmony_ci while (left) { 1662306a36Sopenharmony_ci /* buf must be treated as const if !is_read. */ 1762306a36Sopenharmony_ci ssize_t ret = is_read ? read(fd, buf, left) : 1862306a36Sopenharmony_ci write(fd, buf, left); 1962306a36Sopenharmony_ci 2062306a36Sopenharmony_ci if (ret < 0 && errno == EINTR) 2162306a36Sopenharmony_ci continue; 2262306a36Sopenharmony_ci if (ret <= 0) 2362306a36Sopenharmony_ci return ret; 2462306a36Sopenharmony_ci 2562306a36Sopenharmony_ci left -= ret; 2662306a36Sopenharmony_ci buf += ret; 2762306a36Sopenharmony_ci } 2862306a36Sopenharmony_ci 2962306a36Sopenharmony_ci BUG_ON((size_t)(buf - buf_start) != n); 3062306a36Sopenharmony_ci return n; 3162306a36Sopenharmony_ci} 3262306a36Sopenharmony_ci 3362306a36Sopenharmony_ci/* 3462306a36Sopenharmony_ci * Read exactly 'n' bytes or return an error. 3562306a36Sopenharmony_ci */ 3662306a36Sopenharmony_cissize_t readn(int fd, void *buf, size_t n) 3762306a36Sopenharmony_ci{ 3862306a36Sopenharmony_ci return ion(true, fd, buf, n); 3962306a36Sopenharmony_ci} 4062306a36Sopenharmony_ci 4162306a36Sopenharmony_cissize_t preadn(int fd, void *buf, size_t n, off_t offs) 4262306a36Sopenharmony_ci{ 4362306a36Sopenharmony_ci size_t left = n; 4462306a36Sopenharmony_ci 4562306a36Sopenharmony_ci while (left) { 4662306a36Sopenharmony_ci ssize_t ret = pread(fd, buf, left, offs); 4762306a36Sopenharmony_ci 4862306a36Sopenharmony_ci if (ret < 0 && errno == EINTR) 4962306a36Sopenharmony_ci continue; 5062306a36Sopenharmony_ci if (ret <= 0) 5162306a36Sopenharmony_ci return ret; 5262306a36Sopenharmony_ci 5362306a36Sopenharmony_ci left -= ret; 5462306a36Sopenharmony_ci buf += ret; 5562306a36Sopenharmony_ci offs += ret; 5662306a36Sopenharmony_ci } 5762306a36Sopenharmony_ci 5862306a36Sopenharmony_ci return n; 5962306a36Sopenharmony_ci} 6062306a36Sopenharmony_ci 6162306a36Sopenharmony_ci/* 6262306a36Sopenharmony_ci * Write exactly 'n' bytes or return an error. 6362306a36Sopenharmony_ci */ 6462306a36Sopenharmony_cissize_t writen(int fd, const void *buf, size_t n) 6562306a36Sopenharmony_ci{ 6662306a36Sopenharmony_ci /* ion does not modify buf. */ 6762306a36Sopenharmony_ci return ion(false, fd, (void *)buf, n); 6862306a36Sopenharmony_ci} 69