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