diff --git a/src/libs/ftpd/ftp_file.c b/src/libs/ftpd/ftp_file.c
index 5e2f52d..19e3390 100644
--- a/src/libs/ftpd/ftp_file.c
+++ b/src/libs/ftpd/ftp_file.c
@@ -407,17 +407,15 @@ FRESULT ftps_f_close(FIL *fp)
 	return res;
 }
 
-FRESULT ftps_f_write(FIL *fp, const void *buffer, uint32_t buflen, uint32_t *written)
+FRESULT ftps_f_write(FIL *fp, struct pbuf *p, uint32_t buflen, uint32_t *written)
 {
 	HANDLE hfile = fp->h;
 	FRESULT res = FR_OK;
 
-	const uint8_t *prcvbuf = (const uint8_t *)buffer;
 	// Write the correct amount of bytes to fill up to FILE_CACHE_SIZE exactly.
 	int next_spot = fp->bytes_cached + buflen;
 	int len = (next_spot < FILE_CACHE_SIZE) ? buflen : (buflen - (next_spot - FILE_CACHE_SIZE));
-	memcpy(&fp->cache_buf[fp->cache_index][fp->bytes_cached], prcvbuf, len);
-	fp->bytes_cached += len;
+	fp->bytes_cached += pbuf_copy_partial(p, &fp->cache_buf[fp->cache_index][fp->bytes_cached], len, 0);
 
 	// If we have filled the file write cache, write it out.
 	assert(fp->bytes_cached <= FILE_CACHE_SIZE);
@@ -435,7 +433,7 @@ FRESULT ftps_f_write(FIL *fp, const void *buffer, uint32_t buflen, uint32_t *wri
 		assert(remaining >= 0);
 		if (remaining > 0)
 		{
-			memcpy(fp->cache_buf[fp->cache_index], &prcvbuf[len], remaining);
+			pbuf_copy_partial(p, &fp->cache_buf[fp->cache_index], remaining, len);
 		}
 		fp->bytes_cached = remaining;
 	}
diff --git a/src/libs/ftpd/ftp_file.h b/src/libs/ftpd/ftp_file.h
index 6493aef..ec319fc 100644
--- a/src/libs/ftpd/ftp_file.h
+++ b/src/libs/ftpd/ftp_file.h
@@ -98,7 +98,7 @@ FRESULT ftps_f_unlink(const char *path);
 FRESULT ftps_f_open(FIL *fp, const char *path, uint8_t mode);
 size_t ftps_f_size(FIL *fp);
 FRESULT ftps_f_close(FIL *fp);
-FRESULT ftps_f_write(FIL *fp, const void *buffer, uint32_t len, uint32_t *written);
+FRESULT ftps_f_write(FIL *fp, struct pbuf *p, uint32_t buflen, uint32_t *written);
 FRESULT ftps_f_read(FIL *fp, void *buffer, uint32_t len, uint32_t *read, uint32_t position);
 FRESULT ftps_f_mkdir(const char *path);
 FRESULT ftps_f_rename(const char *from, const char *to);
diff --git a/src/libs/ftpd/ftp_server.c b/src/libs/ftpd/ftp_server.c
index 2206ac0..e5c526c 100644
--- a/src/libs/ftpd/ftp_server.c
+++ b/src/libs/ftpd/ftp_server.c
@@ -1034,16 +1034,14 @@ static void ftp_cmd_stor(ftp_data_t *ftp)
 	ftp_send(ftp, "150 Connected to port %u\r\n", ftp->data_port);
 
 	//
-	struct pbuf *rcvbuf = NULL;
-	void *prcvbuf;
-	uint16_t buflen = 0;
+	struct pbuf *p = NULL;
 	int8_t file_err = 0;
 	int8_t con_err = 0;
 	uint32_t bytes_written = 0;
 	while (1)
 	{
 		// receive data from ftp client ok?
-		con_err = netconn_recv_tcp_pbuf(ftp->dataconn, &rcvbuf);
+		con_err = netconn_recv_tcp_pbuf(ftp->dataconn, &p);
 
 		// socket closed? (end of file)
 		if (con_err == ERR_CLSD)
@@ -1059,10 +1057,8 @@ static void ftp_cmd_stor(ftp_data_t *ftp)
 		}
 
 		// housekeeping
-		prcvbuf = rcvbuf->payload;
-		buflen = rcvbuf->tot_len;
-		file_err = ftps_f_write(&ftp->file, prcvbuf, buflen, (uint32_t *)&bytes_written);
-		pbuf_free(rcvbuf);
+		file_err = ftps_f_write(&ftp->file, p, p->tot_len, (uint32_t *)&bytes_written);
+		pbuf_free(p);
 
 		// error in nested loop?
 		if (file_err != FR_OK)