| 
									
										
										
										
											2021-12-21 12:54:05 +01:00
										 |  |  | /*
 | 
					
						
							|  |  |  |  *  Message Processing Stack, Trace module | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  *  Copyright The Mbed TLS Contributors | 
					
						
							|  |  |  |  *  SPDX-License-Identifier: Apache-2.0 | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  *  Licensed under the Apache License, Version 2.0 (the "License"); you may | 
					
						
							|  |  |  |  *  not use this file except in compliance with the License. | 
					
						
							|  |  |  |  *  You may obtain a copy of the License at | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  *  http://www.apache.org/licenses/LICENSE-2.0
 | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  *  Unless required by applicable law or agreed to in writing, software | 
					
						
							|  |  |  |  *  distributed under the License is distributed on an "AS IS" BASIS, WITHOUT | 
					
						
							|  |  |  |  *  WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. | 
					
						
							|  |  |  |  *  See the License for the specific language governing permissions and | 
					
						
							|  |  |  |  *  limitations under the License. | 
					
						
							|  |  |  |  * | 
					
						
							|  |  |  |  *  This file is part of Mbed TLS (https://tls.mbed.org)
 | 
					
						
							|  |  |  |  */ | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #include "common.h"
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #if defined(MBEDTLS_SSL_PROTO_TLS1_3_EXPERIMENTAL)
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #include "mps_common.h"
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #if defined(MBEDTLS_MPS_ENABLE_TRACE)
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #include "mps_trace.h"
 | 
					
						
							|  |  |  | #include <stdarg.h>
 | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | static int trace_depth = 0; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #define color_default  "\x1B[0m"
 | 
					
						
							|  |  |  | #define color_red      "\x1B[1;31m"
 | 
					
						
							|  |  |  | #define color_green    "\x1B[1;32m"
 | 
					
						
							|  |  |  | #define color_yellow   "\x1B[1;33m"
 | 
					
						
							|  |  |  | #define color_blue     "\x1B[1;34m"
 | 
					
						
							|  |  |  | #define color_magenta  "\x1B[1;35m"
 | 
					
						
							|  |  |  | #define color_cyan     "\x1B[1;36m"
 | 
					
						
							|  |  |  | #define color_white    "\x1B[1;37m"
 | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2023-04-18 10:38:24 +02:00
										 |  |  | static char const *colors[] = | 
					
						
							| 
									
										
										
										
											2021-12-21 12:54:05 +01:00
										 |  |  | { | 
					
						
							|  |  |  |     color_default, | 
					
						
							|  |  |  |     color_green, | 
					
						
							|  |  |  |     color_yellow, | 
					
						
							|  |  |  |     color_magenta, | 
					
						
							|  |  |  |     color_cyan, | 
					
						
							|  |  |  |     color_blue, | 
					
						
							|  |  |  |     color_white | 
					
						
							|  |  |  | }; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #define MPS_TRACE_BUF_SIZE 100
 | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2023-04-18 10:38:24 +02:00
										 |  |  | void mbedtls_mps_trace_print_msg(int id, int line, const char *format, ...) | 
					
						
							| 
									
										
										
										
											2021-12-21 12:54:05 +01:00
										 |  |  | { | 
					
						
							|  |  |  |     int ret; | 
					
						
							|  |  |  |     char str[MPS_TRACE_BUF_SIZE]; | 
					
						
							|  |  |  |     va_list argp; | 
					
						
							| 
									
										
										
										
											2023-04-18 10:38:24 +02:00
										 |  |  |     va_start(argp, format); | 
					
						
							|  |  |  |     ret = mbedtls_vsnprintf(str, MPS_TRACE_BUF_SIZE, format, argp); | 
					
						
							|  |  |  |     va_end(argp); | 
					
						
							| 
									
										
										
										
											2021-12-21 12:54:05 +01:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2023-04-18 10:38:24 +02:00
										 |  |  |     if (ret >= 0 && ret < MPS_TRACE_BUF_SIZE) { | 
					
						
							| 
									
										
										
										
											2021-12-21 12:54:05 +01:00
										 |  |  |         str[ret] = '\0'; | 
					
						
							| 
									
										
										
										
											2023-04-18 10:38:24 +02:00
										 |  |  |         mbedtls_printf("[%d|L%d]: %s\n", id, line, str); | 
					
						
							| 
									
										
										
										
											2021-12-21 12:54:05 +01:00
										 |  |  |     } | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | int mbedtls_mps_trace_get_depth() | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  |     return trace_depth; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | void mbedtls_mps_trace_dec_depth() | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  |     trace_depth--; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | void mbedtls_mps_trace_inc_depth() | 
					
						
							|  |  |  | { | 
					
						
							|  |  |  |     trace_depth++; | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2023-04-18 10:38:24 +02:00
										 |  |  | void mbedtls_mps_trace_color(int id) | 
					
						
							| 
									
										
										
										
											2021-12-21 12:54:05 +01:00
										 |  |  | { | 
					
						
							| 
									
										
										
										
											2023-04-18 10:38:24 +02:00
										 |  |  |     if (id > (int) (sizeof(colors) / sizeof(*colors))) { | 
					
						
							| 
									
										
										
										
											2021-12-21 12:54:05 +01:00
										 |  |  |         return; | 
					
						
							| 
									
										
										
										
											2023-04-18 10:38:24 +02:00
										 |  |  |     } | 
					
						
							|  |  |  |     printf("%s", colors[id]); | 
					
						
							| 
									
										
										
										
											2021-12-21 12:54:05 +01:00
										 |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2023-04-18 10:38:24 +02:00
										 |  |  | void mbedtls_mps_trace_indent(int level, mbedtls_mps_trace_type ty) | 
					
						
							| 
									
										
										
										
											2021-12-21 12:54:05 +01:00
										 |  |  | { | 
					
						
							| 
									
										
										
										
											2023-04-18 10:38:24 +02:00
										 |  |  |     if (level > 0) { | 
					
						
							|  |  |  |         while (--level) { | 
					
						
							|  |  |  |             printf("|  "); | 
					
						
							|  |  |  |         } | 
					
						
							| 
									
										
										
										
											2021-12-21 12:54:05 +01:00
										 |  |  | 
 | 
					
						
							| 
									
										
										
										
											2023-04-18 10:38:24 +02:00
										 |  |  |         printf("|  "); | 
					
						
							| 
									
										
										
										
											2021-12-21 12:54:05 +01:00
										 |  |  |     } | 
					
						
							|  |  |  | 
 | 
					
						
							| 
									
										
										
										
											2023-04-18 10:38:24 +02:00
										 |  |  |     switch (ty) { | 
					
						
							| 
									
										
										
										
											2021-12-21 12:54:05 +01:00
										 |  |  |         case MBEDTLS_MPS_TRACE_TYPE_COMMENT: | 
					
						
							| 
									
										
										
										
											2023-04-18 10:38:24 +02:00
										 |  |  |             mbedtls_printf("@ "); | 
					
						
							| 
									
										
										
										
											2021-12-21 12:54:05 +01:00
										 |  |  |             break; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |         case MBEDTLS_MPS_TRACE_TYPE_CALL: | 
					
						
							| 
									
										
										
										
											2023-04-18 10:38:24 +02:00
										 |  |  |             mbedtls_printf("+--> "); | 
					
						
							| 
									
										
										
										
											2021-12-21 12:54:05 +01:00
										 |  |  |             break; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |         case MBEDTLS_MPS_TRACE_TYPE_ERROR: | 
					
						
							| 
									
										
										
										
											2023-04-18 10:38:24 +02:00
										 |  |  |             mbedtls_printf("E "); | 
					
						
							| 
									
										
										
										
											2021-12-21 12:54:05 +01:00
										 |  |  |             break; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |         case MBEDTLS_MPS_TRACE_TYPE_RETURN: | 
					
						
							| 
									
										
										
										
											2023-04-18 10:38:24 +02:00
										 |  |  |             mbedtls_printf("< "); | 
					
						
							| 
									
										
										
										
											2021-12-21 12:54:05 +01:00
										 |  |  |             break; | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  |         default: | 
					
						
							|  |  |  |             break; | 
					
						
							|  |  |  |     } | 
					
						
							|  |  |  | } | 
					
						
							|  |  |  | 
 | 
					
						
							|  |  |  | #endif /* MBEDTLS_MPS_ENABLE_TRACE */
 | 
					
						
							|  |  |  | #endif /* MBEDTLS_SSL_PROTO_TLS1_3_EXPERIMENTAL */
 |