xref: /freebsd-src/contrib/processor-trace/libipt/src/pt_retstack.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_retstack.h"
3074fe6c29SRuslan Bukin 
3174fe6c29SRuslan Bukin #include "intel-pt.h"
3274fe6c29SRuslan Bukin 
3374fe6c29SRuslan Bukin 
pt_retstack_init(struct pt_retstack * retstack)3474fe6c29SRuslan Bukin void pt_retstack_init(struct pt_retstack *retstack)
3574fe6c29SRuslan Bukin {
3674fe6c29SRuslan Bukin 	if (!retstack)
3774fe6c29SRuslan Bukin 		return;
3874fe6c29SRuslan Bukin 
3974fe6c29SRuslan Bukin 	retstack->top = 0;
4074fe6c29SRuslan Bukin 	retstack->bottom = 0;
4174fe6c29SRuslan Bukin }
4274fe6c29SRuslan Bukin 
pt_retstack_is_empty(const struct pt_retstack * retstack)4374fe6c29SRuslan Bukin int pt_retstack_is_empty(const struct pt_retstack *retstack)
4474fe6c29SRuslan Bukin {
4574fe6c29SRuslan Bukin 	if (!retstack)
4674fe6c29SRuslan Bukin 		return -pte_invalid;
4774fe6c29SRuslan Bukin 
4874fe6c29SRuslan Bukin 	return (retstack->top == retstack->bottom ? 1 : 0);
4974fe6c29SRuslan Bukin }
5074fe6c29SRuslan Bukin 
pt_retstack_pop(struct pt_retstack * retstack,uint64_t * ip)5174fe6c29SRuslan Bukin int pt_retstack_pop(struct pt_retstack *retstack, uint64_t *ip)
5274fe6c29SRuslan Bukin {
5374fe6c29SRuslan Bukin 	uint8_t top;
5474fe6c29SRuslan Bukin 
5574fe6c29SRuslan Bukin 	if (!retstack)
5674fe6c29SRuslan Bukin 		return -pte_invalid;
5774fe6c29SRuslan Bukin 
5874fe6c29SRuslan Bukin 	top = retstack->top;
5974fe6c29SRuslan Bukin 
6074fe6c29SRuslan Bukin 	if (top == retstack->bottom)
6174fe6c29SRuslan Bukin 		return -pte_retstack_empty;
6274fe6c29SRuslan Bukin 
6374fe6c29SRuslan Bukin 	top = (!top ? pt_retstack_size : top - 1);
6474fe6c29SRuslan Bukin 
6574fe6c29SRuslan Bukin 	retstack->top = top;
6674fe6c29SRuslan Bukin 
6774fe6c29SRuslan Bukin 	if (ip)
6874fe6c29SRuslan Bukin 		*ip = retstack->stack[top];
6974fe6c29SRuslan Bukin 
7074fe6c29SRuslan Bukin 	return 0;
7174fe6c29SRuslan Bukin }
7274fe6c29SRuslan Bukin 
pt_retstack_push(struct pt_retstack * retstack,uint64_t ip)7374fe6c29SRuslan Bukin int pt_retstack_push(struct pt_retstack *retstack, uint64_t ip)
7474fe6c29SRuslan Bukin {
7574fe6c29SRuslan Bukin 	uint8_t top, bottom;
7674fe6c29SRuslan Bukin 
7774fe6c29SRuslan Bukin 	if (!retstack)
7874fe6c29SRuslan Bukin 		return -pte_invalid;
7974fe6c29SRuslan Bukin 
8074fe6c29SRuslan Bukin 	top = retstack->top;
8174fe6c29SRuslan Bukin 	bottom = retstack->bottom;
8274fe6c29SRuslan Bukin 
8374fe6c29SRuslan Bukin 	retstack->stack[top] = ip;
8474fe6c29SRuslan Bukin 
8574fe6c29SRuslan Bukin 	top = (top == pt_retstack_size ? 0 : top + 1);
8674fe6c29SRuslan Bukin 
8774fe6c29SRuslan Bukin 	if (bottom == top)
8874fe6c29SRuslan Bukin 		bottom = (bottom == pt_retstack_size ? 0 : bottom + 1);
8974fe6c29SRuslan Bukin 
9074fe6c29SRuslan Bukin 	retstack->top = top;
9174fe6c29SRuslan Bukin 	retstack->bottom = bottom;
9274fe6c29SRuslan Bukin 
9374fe6c29SRuslan Bukin 	return 0;
9474fe6c29SRuslan Bukin }
95