xref: /freebsd-src/contrib/processor-trace/libipt/src/posix/pt_section_posix.c (revision 85f87cf491bec6f90948a85b10f5523ea24db9e3)
174fe6c29SRuslan Bukin /*
2*85f87cf4SRuslan Bukin  * Copyright (c) 2013-2019, Intel Corporation
374fe6c29SRuslan Bukin  *
474fe6c29SRuslan Bukin  * Redistribution and use in source and binary forms, with or without
574fe6c29SRuslan Bukin  * modification, are permitted provided that the following conditions are met:
674fe6c29SRuslan Bukin  *
774fe6c29SRuslan Bukin  *  * Redistributions of source code must retain the above copyright notice,
874fe6c29SRuslan Bukin  *    this list of conditions and the following disclaimer.
974fe6c29SRuslan Bukin  *  * Redistributions in binary form must reproduce the above copyright notice,
1074fe6c29SRuslan Bukin  *    this list of conditions and the following disclaimer in the documentation
1174fe6c29SRuslan Bukin  *    and/or other materials provided with the distribution.
1274fe6c29SRuslan Bukin  *  * Neither the name of Intel Corporation nor the names of its contributors
1374fe6c29SRuslan Bukin  *    may be used to endorse or promote products derived from this software
1474fe6c29SRuslan Bukin  *    without specific prior written permission.
1574fe6c29SRuslan Bukin  *
1674fe6c29SRuslan Bukin  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
1774fe6c29SRuslan Bukin  * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
1874fe6c29SRuslan Bukin  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
1974fe6c29SRuslan Bukin  * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE
2074fe6c29SRuslan Bukin  * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
2174fe6c29SRuslan Bukin  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
2274fe6c29SRuslan Bukin  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
2374fe6c29SRuslan Bukin  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
2474fe6c29SRuslan Bukin  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
2574fe6c29SRuslan Bukin  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
2674fe6c29SRuslan Bukin  * POSSIBILITY OF SUCH DAMAGE.
2774fe6c29SRuslan Bukin  */
2874fe6c29SRuslan Bukin 
2974fe6c29SRuslan Bukin #include "pt_section.h"
3074fe6c29SRuslan Bukin #include "pt_section_posix.h"
3174fe6c29SRuslan Bukin #include "pt_section_file.h"
3274fe6c29SRuslan Bukin 
3374fe6c29SRuslan Bukin #include "intel-pt.h"
3474fe6c29SRuslan Bukin 
3574fe6c29SRuslan Bukin #include <stdio.h>
3674fe6c29SRuslan Bukin #include <stdlib.h>
3774fe6c29SRuslan Bukin #include <string.h>
3874fe6c29SRuslan Bukin #include <limits.h>
3974fe6c29SRuslan Bukin #include <sys/types.h>
4074fe6c29SRuslan Bukin #include <sys/mman.h>
4174fe6c29SRuslan Bukin #include <fcntl.h>
4274fe6c29SRuslan Bukin #include <unistd.h>
4374fe6c29SRuslan Bukin 
4474fe6c29SRuslan Bukin 
pt_section_mk_status(void ** pstatus,uint64_t * psize,const char * filename)4574fe6c29SRuslan Bukin int pt_section_mk_status(void **pstatus, uint64_t *psize, const char *filename)
4674fe6c29SRuslan Bukin {
4774fe6c29SRuslan Bukin 	struct pt_sec_posix_status *status;
4874fe6c29SRuslan Bukin 	struct stat buffer;
4974fe6c29SRuslan Bukin 	int errcode;
5074fe6c29SRuslan Bukin 
5174fe6c29SRuslan Bukin 	if (!pstatus || !psize)
5274fe6c29SRuslan Bukin 		return -pte_internal;
5374fe6c29SRuslan Bukin 
5474fe6c29SRuslan Bukin 	errcode = stat(filename, &buffer);
5574fe6c29SRuslan Bukin 	if (errcode < 0)
56*85f87cf4SRuslan Bukin 		return -pte_bad_file;
5774fe6c29SRuslan Bukin 
5874fe6c29SRuslan Bukin 	if (buffer.st_size < 0)
5974fe6c29SRuslan Bukin 		return -pte_bad_image;
6074fe6c29SRuslan Bukin 
6174fe6c29SRuslan Bukin 	status = malloc(sizeof(*status));
6274fe6c29SRuslan Bukin 	if (!status)
6374fe6c29SRuslan Bukin 		return -pte_nomem;
6474fe6c29SRuslan Bukin 
6574fe6c29SRuslan Bukin 	status->stat = buffer;
6674fe6c29SRuslan Bukin 
6774fe6c29SRuslan Bukin 	*pstatus = status;
68*85f87cf4SRuslan Bukin 	*psize = (uint64_t) buffer.st_size;
6974fe6c29SRuslan Bukin 
7074fe6c29SRuslan Bukin 	return 0;
7174fe6c29SRuslan Bukin }
7274fe6c29SRuslan Bukin 
check_file_status(struct pt_section * section,int fd)7374fe6c29SRuslan Bukin static int check_file_status(struct pt_section *section, int fd)
7474fe6c29SRuslan Bukin {
7574fe6c29SRuslan Bukin 	struct pt_sec_posix_status *status;
7674fe6c29SRuslan Bukin 	struct stat stat;
7774fe6c29SRuslan Bukin 	int errcode;
7874fe6c29SRuslan Bukin 
7974fe6c29SRuslan Bukin 	if (!section)
8074fe6c29SRuslan Bukin 		return -pte_internal;
8174fe6c29SRuslan Bukin 
8274fe6c29SRuslan Bukin 	errcode = fstat(fd, &stat);
8374fe6c29SRuslan Bukin 	if (errcode)
84*85f87cf4SRuslan Bukin 		return -pte_bad_file;
8574fe6c29SRuslan Bukin 
8674fe6c29SRuslan Bukin 	status = section->status;
8774fe6c29SRuslan Bukin 	if (!status)
8874fe6c29SRuslan Bukin 		return -pte_internal;
8974fe6c29SRuslan Bukin 
9074fe6c29SRuslan Bukin 	if (stat.st_size != status->stat.st_size)
9174fe6c29SRuslan Bukin 		return -pte_bad_image;
9274fe6c29SRuslan Bukin 
9374fe6c29SRuslan Bukin 	if (stat.st_mtime != status->stat.st_mtime)
9474fe6c29SRuslan Bukin 		return -pte_bad_image;
9574fe6c29SRuslan Bukin 
9674fe6c29SRuslan Bukin 	return 0;
9774fe6c29SRuslan Bukin }
9874fe6c29SRuslan Bukin 
pt_sec_posix_map(struct pt_section * section,int fd)9974fe6c29SRuslan Bukin int pt_sec_posix_map(struct pt_section *section, int fd)
10074fe6c29SRuslan Bukin {
10174fe6c29SRuslan Bukin 	struct pt_sec_posix_mapping *mapping;
10274fe6c29SRuslan Bukin 	uint64_t offset, size, adjustment;
10374fe6c29SRuslan Bukin 	uint8_t *base;
104*85f87cf4SRuslan Bukin 	long page_size;
10574fe6c29SRuslan Bukin 	int errcode;
10674fe6c29SRuslan Bukin 
10774fe6c29SRuslan Bukin 	if (!section)
10874fe6c29SRuslan Bukin 		return -pte_internal;
10974fe6c29SRuslan Bukin 
11074fe6c29SRuslan Bukin 	offset = section->offset;
11174fe6c29SRuslan Bukin 	size = section->size;
11274fe6c29SRuslan Bukin 
113*85f87cf4SRuslan Bukin 	page_size = sysconf(_SC_PAGESIZE);
114*85f87cf4SRuslan Bukin 	if (page_size < 0)
115*85f87cf4SRuslan Bukin 		return -pte_bad_config;
116*85f87cf4SRuslan Bukin 
117*85f87cf4SRuslan Bukin 	adjustment = offset % (uint64_t) page_size;
11874fe6c29SRuslan Bukin 
11974fe6c29SRuslan Bukin 	offset -= adjustment;
12074fe6c29SRuslan Bukin 	size += adjustment;
12174fe6c29SRuslan Bukin 
12274fe6c29SRuslan Bukin 	/* The section is supposed to fit into the file so we shouldn't
12374fe6c29SRuslan Bukin 	 * see any overflows, here.
12474fe6c29SRuslan Bukin 	 */
12574fe6c29SRuslan Bukin 	if (size < section->size)
12674fe6c29SRuslan Bukin 		return -pte_internal;
12774fe6c29SRuslan Bukin 
12874fe6c29SRuslan Bukin 	if (SIZE_MAX < size)
12974fe6c29SRuslan Bukin 		return -pte_nomem;
13074fe6c29SRuslan Bukin 
13174fe6c29SRuslan Bukin 	if (INT_MAX < offset)
13274fe6c29SRuslan Bukin 		return -pte_nomem;
13374fe6c29SRuslan Bukin 
13474fe6c29SRuslan Bukin 	base = mmap(NULL, (size_t) size, PROT_READ, MAP_SHARED, fd,
13574fe6c29SRuslan Bukin 		    (off_t) offset);
13674fe6c29SRuslan Bukin 	if (base == MAP_FAILED)
13774fe6c29SRuslan Bukin 		return -pte_nomem;
13874fe6c29SRuslan Bukin 
13974fe6c29SRuslan Bukin 	mapping = malloc(sizeof(*mapping));
14074fe6c29SRuslan Bukin 	if (!mapping) {
14174fe6c29SRuslan Bukin 		errcode = -pte_nomem;
14274fe6c29SRuslan Bukin 		goto out_map;
14374fe6c29SRuslan Bukin 	}
14474fe6c29SRuslan Bukin 
14574fe6c29SRuslan Bukin 	mapping->base = base;
14674fe6c29SRuslan Bukin 	mapping->size = size;
14774fe6c29SRuslan Bukin 	mapping->begin = base + adjustment;
14874fe6c29SRuslan Bukin 	mapping->end = base + size;
14974fe6c29SRuslan Bukin 
15074fe6c29SRuslan Bukin 	section->mapping = mapping;
15174fe6c29SRuslan Bukin 	section->unmap = pt_sec_posix_unmap;
15274fe6c29SRuslan Bukin 	section->read = pt_sec_posix_read;
15374fe6c29SRuslan Bukin 	section->memsize = pt_sec_posix_memsize;
15474fe6c29SRuslan Bukin 
15574fe6c29SRuslan Bukin 	return 0;
15674fe6c29SRuslan Bukin 
15774fe6c29SRuslan Bukin out_map:
15874fe6c29SRuslan Bukin 	munmap(base, (size_t) size);
15974fe6c29SRuslan Bukin 	return errcode;
16074fe6c29SRuslan Bukin }
16174fe6c29SRuslan Bukin 
pt_sec_posix_map_success(struct pt_section * section)16274fe6c29SRuslan Bukin static int pt_sec_posix_map_success(struct pt_section *section)
16374fe6c29SRuslan Bukin {
16474fe6c29SRuslan Bukin 	uint16_t mcount;
16574fe6c29SRuslan Bukin 	int errcode, status;
16674fe6c29SRuslan Bukin 
16774fe6c29SRuslan Bukin 	if (!section)
16874fe6c29SRuslan Bukin 		return -pte_internal;
16974fe6c29SRuslan Bukin 
17074fe6c29SRuslan Bukin 	mcount = section->mcount + 1;
17174fe6c29SRuslan Bukin 	if (!mcount) {
17274fe6c29SRuslan Bukin 		(void) pt_section_unlock(section);
17374fe6c29SRuslan Bukin 		return -pte_overflow;
17474fe6c29SRuslan Bukin 	}
17574fe6c29SRuslan Bukin 
17674fe6c29SRuslan Bukin 	section->mcount = mcount;
17774fe6c29SRuslan Bukin 
17874fe6c29SRuslan Bukin 	errcode = pt_section_unlock(section);
17974fe6c29SRuslan Bukin 	if (errcode < 0)
18074fe6c29SRuslan Bukin 		return errcode;
18174fe6c29SRuslan Bukin 
18274fe6c29SRuslan Bukin 	status = pt_section_on_map(section);
18374fe6c29SRuslan Bukin 	if (status < 0) {
18474fe6c29SRuslan Bukin 		/* We had to release the section lock for pt_section_on_map() so
18574fe6c29SRuslan Bukin 		 * @section may have meanwhile been mapped by other threads.
18674fe6c29SRuslan Bukin 		 *
18774fe6c29SRuslan Bukin 		 * We still want to return the error so we release our mapping.
18874fe6c29SRuslan Bukin 		 * Our caller does not yet know whether pt_section_map()
18974fe6c29SRuslan Bukin 		 * succeeded.
19074fe6c29SRuslan Bukin 		 */
19174fe6c29SRuslan Bukin 		(void) pt_section_unmap(section);
19274fe6c29SRuslan Bukin 		return status;
19374fe6c29SRuslan Bukin 	}
19474fe6c29SRuslan Bukin 
19574fe6c29SRuslan Bukin 	return 0;
19674fe6c29SRuslan Bukin }
19774fe6c29SRuslan Bukin 
pt_section_map(struct pt_section * section)19874fe6c29SRuslan Bukin int pt_section_map(struct pt_section *section)
19974fe6c29SRuslan Bukin {
20074fe6c29SRuslan Bukin 	const char *filename;
20174fe6c29SRuslan Bukin 	FILE *file;
20274fe6c29SRuslan Bukin 	int fd, errcode;
20374fe6c29SRuslan Bukin 
20474fe6c29SRuslan Bukin 	if (!section)
20574fe6c29SRuslan Bukin 		return -pte_internal;
20674fe6c29SRuslan Bukin 
20774fe6c29SRuslan Bukin 	errcode = pt_section_lock(section);
20874fe6c29SRuslan Bukin 	if (errcode < 0)
20974fe6c29SRuslan Bukin 		return errcode;
21074fe6c29SRuslan Bukin 
21174fe6c29SRuslan Bukin 	if (section->mcount)
21274fe6c29SRuslan Bukin 		return pt_sec_posix_map_success(section);
21374fe6c29SRuslan Bukin 
21474fe6c29SRuslan Bukin 	if (section->mapping)
21574fe6c29SRuslan Bukin 		goto out_unlock;
21674fe6c29SRuslan Bukin 
21774fe6c29SRuslan Bukin 	filename = section->filename;
21874fe6c29SRuslan Bukin 	if (!filename)
21974fe6c29SRuslan Bukin 		goto out_unlock;
22074fe6c29SRuslan Bukin 
221*85f87cf4SRuslan Bukin 	errcode = -pte_bad_file;
22274fe6c29SRuslan Bukin 	fd = open(filename, O_RDONLY);
22374fe6c29SRuslan Bukin 	if (fd == -1)
22474fe6c29SRuslan Bukin 		goto out_unlock;
22574fe6c29SRuslan Bukin 
22674fe6c29SRuslan Bukin 	errcode = check_file_status(section, fd);
22774fe6c29SRuslan Bukin 	if (errcode < 0)
22874fe6c29SRuslan Bukin 		goto out_fd;
22974fe6c29SRuslan Bukin 
23074fe6c29SRuslan Bukin 	/* We close the file on success.  This does not unmap the section. */
23174fe6c29SRuslan Bukin 	errcode = pt_sec_posix_map(section, fd);
23274fe6c29SRuslan Bukin 	if (!errcode) {
23374fe6c29SRuslan Bukin 		close(fd);
23474fe6c29SRuslan Bukin 
23574fe6c29SRuslan Bukin 		return pt_sec_posix_map_success(section);
23674fe6c29SRuslan Bukin 	}
23774fe6c29SRuslan Bukin 
23874fe6c29SRuslan Bukin 	/* Fall back to file based sections - report the original error
23974fe6c29SRuslan Bukin 	 * if we fail to convert the file descriptor.
24074fe6c29SRuslan Bukin 	 */
24174fe6c29SRuslan Bukin 	file = fdopen(fd, "rb");
242*85f87cf4SRuslan Bukin 	if (!file) {
243*85f87cf4SRuslan Bukin 		errcode = -pte_bad_file;
24474fe6c29SRuslan Bukin 		goto out_fd;
245*85f87cf4SRuslan Bukin 	}
24674fe6c29SRuslan Bukin 
24774fe6c29SRuslan Bukin 	/* We need to keep the file open on success.  It will be closed when
24874fe6c29SRuslan Bukin 	 * the section is unmapped.
24974fe6c29SRuslan Bukin 	 */
25074fe6c29SRuslan Bukin 	errcode = pt_sec_file_map(section, file);
25174fe6c29SRuslan Bukin 	if (!errcode)
25274fe6c29SRuslan Bukin 		return pt_sec_posix_map_success(section);
25374fe6c29SRuslan Bukin 
25474fe6c29SRuslan Bukin 	fclose(file);
25574fe6c29SRuslan Bukin 	goto out_unlock;
25674fe6c29SRuslan Bukin 
25774fe6c29SRuslan Bukin out_fd:
25874fe6c29SRuslan Bukin 	close(fd);
25974fe6c29SRuslan Bukin 
26074fe6c29SRuslan Bukin out_unlock:
26174fe6c29SRuslan Bukin 	(void) pt_section_unlock(section);
26274fe6c29SRuslan Bukin 	return errcode;
26374fe6c29SRuslan Bukin }
26474fe6c29SRuslan Bukin 
pt_sec_posix_unmap(struct pt_section * section)26574fe6c29SRuslan Bukin int pt_sec_posix_unmap(struct pt_section *section)
26674fe6c29SRuslan Bukin {
26774fe6c29SRuslan Bukin 	struct pt_sec_posix_mapping *mapping;
26874fe6c29SRuslan Bukin 
26974fe6c29SRuslan Bukin 	if (!section)
27074fe6c29SRuslan Bukin 		return -pte_internal;
27174fe6c29SRuslan Bukin 
27274fe6c29SRuslan Bukin 	mapping = section->mapping;
27374fe6c29SRuslan Bukin 	if (!mapping || !section->unmap || !section->read || !section->memsize)
27474fe6c29SRuslan Bukin 		return -pte_internal;
27574fe6c29SRuslan Bukin 
27674fe6c29SRuslan Bukin 	section->mapping = NULL;
27774fe6c29SRuslan Bukin 	section->unmap = NULL;
27874fe6c29SRuslan Bukin 	section->read = NULL;
27974fe6c29SRuslan Bukin 	section->memsize = NULL;
28074fe6c29SRuslan Bukin 
28174fe6c29SRuslan Bukin 	munmap(mapping->base, (size_t) mapping->size);
28274fe6c29SRuslan Bukin 	free(mapping);
28374fe6c29SRuslan Bukin 
28474fe6c29SRuslan Bukin 	return 0;
28574fe6c29SRuslan Bukin }
28674fe6c29SRuslan Bukin 
pt_sec_posix_read(const struct pt_section * section,uint8_t * buffer,uint16_t size,uint64_t offset)28774fe6c29SRuslan Bukin int pt_sec_posix_read(const struct pt_section *section, uint8_t *buffer,
28874fe6c29SRuslan Bukin 		      uint16_t size, uint64_t offset)
28974fe6c29SRuslan Bukin {
29074fe6c29SRuslan Bukin 	struct pt_sec_posix_mapping *mapping;
29174fe6c29SRuslan Bukin 	const uint8_t *begin;
29274fe6c29SRuslan Bukin 
29374fe6c29SRuslan Bukin 	if (!buffer || !section)
29474fe6c29SRuslan Bukin 		return -pte_internal;
29574fe6c29SRuslan Bukin 
29674fe6c29SRuslan Bukin 	mapping = section->mapping;
29774fe6c29SRuslan Bukin 	if (!mapping)
29874fe6c29SRuslan Bukin 		return -pte_internal;
29974fe6c29SRuslan Bukin 
30074fe6c29SRuslan Bukin 	/* We already checked in pt_section_read() that the requested memory
30174fe6c29SRuslan Bukin 	 * lies within the section's boundaries.
30274fe6c29SRuslan Bukin 	 *
30374fe6c29SRuslan Bukin 	 * And we checked that the entire section was mapped.  There's no need
30474fe6c29SRuslan Bukin 	 * to check for overflows, again.
30574fe6c29SRuslan Bukin 	 */
30674fe6c29SRuslan Bukin 	begin = mapping->begin + offset;
30774fe6c29SRuslan Bukin 
30874fe6c29SRuslan Bukin 	memcpy(buffer, begin, size);
30974fe6c29SRuslan Bukin 	return (int) size;
31074fe6c29SRuslan Bukin }
31174fe6c29SRuslan Bukin 
pt_sec_posix_memsize(const struct pt_section * section,uint64_t * size)31274fe6c29SRuslan Bukin int pt_sec_posix_memsize(const struct pt_section *section, uint64_t *size)
31374fe6c29SRuslan Bukin {
31474fe6c29SRuslan Bukin 	struct pt_sec_posix_mapping *mapping;
31574fe6c29SRuslan Bukin 	const uint8_t *begin, *end;
31674fe6c29SRuslan Bukin 
31774fe6c29SRuslan Bukin 	if (!section || !size)
31874fe6c29SRuslan Bukin 		return -pte_internal;
31974fe6c29SRuslan Bukin 
32074fe6c29SRuslan Bukin 	mapping = section->mapping;
32174fe6c29SRuslan Bukin 	if (!mapping)
32274fe6c29SRuslan Bukin 		return -pte_internal;
32374fe6c29SRuslan Bukin 
32474fe6c29SRuslan Bukin 	begin = mapping->base;
32574fe6c29SRuslan Bukin 	end = mapping->end;
32674fe6c29SRuslan Bukin 
32774fe6c29SRuslan Bukin 	if (!begin || !end || end < begin)
32874fe6c29SRuslan Bukin 		return -pte_internal;
32974fe6c29SRuslan Bukin 
33074fe6c29SRuslan Bukin 	*size = (uint64_t) (end - begin);
33174fe6c29SRuslan Bukin 
33274fe6c29SRuslan Bukin 	return 0;
33374fe6c29SRuslan Bukin }
334