| File: | build-scan/../src/vconsole/vconsole-setup.c |
| Warning: | line 242, column 21 Potential leak of memory pointed to by 'unipairs' |
Press '?' to see keyboard shortcuts
Keyboard shortcuts:
| 1 | /* SPDX-License-Identifier: LGPL-2.1+ */ | ||||
| 2 | /*** | ||||
| 3 | Copyright © 2016 Michal Soltys <soltys@ziu.info> | ||||
| 4 | ***/ | ||||
| 5 | |||||
| 6 | #include <errno(*__errno_location ()).h> | ||||
| 7 | #include <fcntl.h> | ||||
| 8 | #include <limits.h> | ||||
| 9 | #include <linux1/kd.h> | ||||
| 10 | #include <linux1/tiocl.h> | ||||
| 11 | #include <linux1/vt.h> | ||||
| 12 | #include <stdbool.h> | ||||
| 13 | #include <stdio.h> | ||||
| 14 | #include <stdlib.h> | ||||
| 15 | #include <sys/ioctl.h> | ||||
| 16 | #include <sysexits.h> | ||||
| 17 | #include <termios.h> | ||||
| 18 | #include <unistd.h> | ||||
| 19 | |||||
| 20 | #include "alloc-util.h" | ||||
| 21 | #include "fd-util.h" | ||||
| 22 | #include "fileio.h" | ||||
| 23 | #include "io-util.h" | ||||
| 24 | #include "locale-util.h" | ||||
| 25 | #include "log.h" | ||||
| 26 | #include "process-util.h" | ||||
| 27 | #include "signal-util.h" | ||||
| 28 | #include "stdio-util.h" | ||||
| 29 | #include "string-util.h" | ||||
| 30 | #include "strv.h" | ||||
| 31 | #include "terminal-util.h" | ||||
| 32 | #include "util.h" | ||||
| 33 | #include "virt.h" | ||||
| 34 | |||||
| 35 | static int verify_vc_device(int fd) { | ||||
| 36 | unsigned char data[] = { | ||||
| 37 | TIOCL_GETFGCONSOLE12, | ||||
| 38 | }; | ||||
| 39 | |||||
| 40 | int r; | ||||
| 41 | |||||
| 42 | r = ioctl(fd, TIOCLINUX0x541C, data); | ||||
| 43 | if (r < 0) | ||||
| 44 | return -errno(*__errno_location ()); | ||||
| 45 | |||||
| 46 | return r; | ||||
| 47 | } | ||||
| 48 | |||||
| 49 | static int verify_vc_allocation(unsigned idx) { | ||||
| 50 | char vcname[sizeof("/dev/vcs") + DECIMAL_STR_MAX(unsigned)(2+(sizeof(unsigned) <= 1 ? 3 : sizeof(unsigned) <= 2 ? 5 : sizeof(unsigned) <= 4 ? 10 : sizeof(unsigned) <= 8 ? 20 : sizeof(int[-2*(sizeof(unsigned) > 8)]))) - 2]; | ||||
| 51 | |||||
| 52 | xsprintf(vcname, "/dev/vcs%u", idx)do { if ((__builtin_expect(!!(!(((size_t) snprintf(vcname, __extension__ (__builtin_choose_expr( !__builtin_types_compatible_p(typeof (vcname), typeof(&*(vcname))), sizeof(vcname)/sizeof((vcname )[0]), ((void)0))), "/dev/vcs%u", idx) < (__extension__ (__builtin_choose_expr ( !__builtin_types_compatible_p(typeof(vcname), typeof(&* (vcname))), sizeof(vcname)/sizeof((vcname)[0]), ((void)0))))) )),0))) log_assert_failed_realm(LOG_REALM_SYSTEMD, ("xsprintf: " "vcname" "[] must be big enough"), "../src/vconsole/vconsole-setup.c" , 52, __PRETTY_FUNCTION__); } while (0); | ||||
| 53 | |||||
| 54 | if (access(vcname, F_OK0) < 0) | ||||
| 55 | return -errno(*__errno_location ()); | ||||
| 56 | |||||
| 57 | return 0; | ||||
| 58 | } | ||||
| 59 | |||||
| 60 | static int verify_vc_allocation_byfd(int fd) { | ||||
| 61 | struct vt_stat vcs = {}; | ||||
| 62 | |||||
| 63 | if (ioctl(fd, VT_GETSTATE0x5603, &vcs) < 0) | ||||
| 64 | return -errno(*__errno_location ()); | ||||
| 65 | |||||
| 66 | return verify_vc_allocation(vcs.v_active); | ||||
| 67 | } | ||||
| 68 | |||||
| 69 | static int verify_vc_kbmode(int fd) { | ||||
| 70 | int curr_mode; | ||||
| 71 | |||||
| 72 | /* | ||||
| 73 | * Make sure we only adjust consoles in K_XLATE or K_UNICODE mode. | ||||
| 74 | * Otherwise we would (likely) interfere with X11's processing of the | ||||
| 75 | * key events. | ||||
| 76 | * | ||||
| 77 | * http://lists.freedesktop.org/archives/systemd-devel/2013-February/008573.html | ||||
| 78 | */ | ||||
| 79 | |||||
| 80 | if (ioctl(fd, KDGKBMODE0x4B44, &curr_mode) < 0) | ||||
| 81 | return -errno(*__errno_location ()); | ||||
| 82 | |||||
| 83 | return IN_SET(curr_mode, K_XLATE, K_UNICODE)({ _Bool _found = 0; static __attribute__ ((unused)) char _static_assert__macros_need_to_be_extended [20 - sizeof((int[]){0x01, 0x03})/sizeof(int)]; switch(curr_mode ) { case 0x01: case 0x03: _found = 1; break; default: break; } _found; }) ? 0 : -EBUSY16; | ||||
| 84 | } | ||||
| 85 | |||||
| 86 | static int toggle_utf8(const char *name, int fd, bool_Bool utf8) { | ||||
| 87 | int r; | ||||
| 88 | struct termios tc = {}; | ||||
| 89 | |||||
| 90 | assert(name)do { if ((__builtin_expect(!!(!(name)),0))) log_assert_failed_realm (LOG_REALM_SYSTEMD, ("name"), "../src/vconsole/vconsole-setup.c" , 90, __PRETTY_FUNCTION__); } while (0); | ||||
| 91 | |||||
| 92 | r = ioctl(fd, KDSKBMODE0x4B45, utf8 ? K_UNICODE0x03 : K_XLATE0x01); | ||||
| 93 | if (r < 0) | ||||
| 94 | return log_warning_errno(errno, "Failed to %s UTF-8 kbdmode on %s: %m", enable_disable(utf8), name)({ int _level = ((4)), _e = (((*__errno_location ()))), _realm = (LOG_REALM_SYSTEMD); (log_get_max_level_realm(_realm) >= ((_level) & 0x07)) ? log_internal_realm(((_realm) << 10 | (_level)), _e, "../src/vconsole/vconsole-setup.c", 94, __func__ , "Failed to %s UTF-8 kbdmode on %s: %m", enable_disable(utf8 ), name) : -abs(_e); }); | ||||
| 95 | |||||
| 96 | r = loop_write(fd, utf8 ? "\033%G" : "\033%@", 3, false0); | ||||
| 97 | if (r < 0) | ||||
| 98 | return log_warning_errno(r, "Failed to %s UTF-8 term processing on %s: %m", enable_disable(utf8), name)({ int _level = ((4)), _e = ((r)), _realm = (LOG_REALM_SYSTEMD ); (log_get_max_level_realm(_realm) >= ((_level) & 0x07 )) ? log_internal_realm(((_realm) << 10 | (_level)), _e , "../src/vconsole/vconsole-setup.c", 98, __func__, "Failed to %s UTF-8 term processing on %s: %m" , enable_disable(utf8), name) : -abs(_e); }); | ||||
| 99 | |||||
| 100 | r = tcgetattr(fd, &tc); | ||||
| 101 | if (r >= 0) { | ||||
| 102 | SET_FLAG(tc.c_iflag, IUTF8, utf8)(tc.c_iflag) = (utf8) ? ((tc.c_iflag) | (0040000)) : ((tc.c_iflag ) & ~(0040000)); | ||||
| 103 | r = tcsetattr(fd, TCSANOW0, &tc); | ||||
| 104 | } | ||||
| 105 | if (r < 0) | ||||
| 106 | return log_warning_errno(errno, "Failed to %s iutf8 flag on %s: %m", enable_disable(utf8), name)({ int _level = ((4)), _e = (((*__errno_location ()))), _realm = (LOG_REALM_SYSTEMD); (log_get_max_level_realm(_realm) >= ((_level) & 0x07)) ? log_internal_realm(((_realm) << 10 | (_level)), _e, "../src/vconsole/vconsole-setup.c", 106, __func__, "Failed to %s iutf8 flag on %s: %m", enable_disable (utf8), name) : -abs(_e); }); | ||||
| 107 | |||||
| 108 | log_debug("UTF-8 kbdmode %sd on %s", enable_disable(utf8), name)({ int _level = (((7))), _e = ((0)), _realm = (LOG_REALM_SYSTEMD ); (log_get_max_level_realm(_realm) >= ((_level) & 0x07 )) ? log_internal_realm(((_realm) << 10 | (_level)), _e , "../src/vconsole/vconsole-setup.c", 108, __func__, "UTF-8 kbdmode %sd on %s" , enable_disable(utf8), name) : -abs(_e); }); | ||||
| 109 | return 0; | ||||
| 110 | } | ||||
| 111 | |||||
| 112 | static int toggle_utf8_sysfs(bool_Bool utf8) { | ||||
| 113 | int r; | ||||
| 114 | |||||
| 115 | r = write_string_file("/sys/module/vt/parameters/default_utf8", one_zero(utf8), 0); | ||||
| 116 | if (r < 0) | ||||
| 117 | return log_warning_errno(r, "Failed to %s sysfs UTF-8 flag: %m", enable_disable(utf8))({ int _level = ((4)), _e = ((r)), _realm = (LOG_REALM_SYSTEMD ); (log_get_max_level_realm(_realm) >= ((_level) & 0x07 )) ? log_internal_realm(((_realm) << 10 | (_level)), _e , "../src/vconsole/vconsole-setup.c", 117, __func__, "Failed to %s sysfs UTF-8 flag: %m" , enable_disable(utf8)) : -abs(_e); }); | ||||
| 118 | |||||
| 119 | log_debug("Sysfs UTF-8 flag %sd", enable_disable(utf8))({ int _level = (((7))), _e = ((0)), _realm = (LOG_REALM_SYSTEMD ); (log_get_max_level_realm(_realm) >= ((_level) & 0x07 )) ? log_internal_realm(((_realm) << 10 | (_level)), _e , "../src/vconsole/vconsole-setup.c", 119, __func__, "Sysfs UTF-8 flag %sd" , enable_disable(utf8)) : -abs(_e); }); | ||||
| 120 | return 0; | ||||
| 121 | } | ||||
| 122 | |||||
| 123 | static int keyboard_load_and_wait(const char *vc, const char *map, const char *map_toggle, bool_Bool utf8) { | ||||
| 124 | const char *args[8]; | ||||
| 125 | unsigned i = 0; | ||||
| 126 | pid_t pid; | ||||
| 127 | int r; | ||||
| 128 | |||||
| 129 | /* An empty map means kernel map */ | ||||
| 130 | if (isempty(map)) | ||||
| 131 | return 0; | ||||
| 132 | |||||
| 133 | args[i++] = KBD_LOADKEYS"/bin/loadkeys"; | ||||
| 134 | args[i++] = "-q"; | ||||
| 135 | args[i++] = "-C"; | ||||
| 136 | args[i++] = vc; | ||||
| 137 | if (utf8) | ||||
| 138 | args[i++] = "-u"; | ||||
| 139 | args[i++] = map; | ||||
| 140 | if (map_toggle) | ||||
| 141 | args[i++] = map_toggle; | ||||
| 142 | args[i++] = NULL((void*)0); | ||||
| 143 | |||||
| 144 | if (DEBUG_LOGGING(__builtin_expect(!!(log_get_max_level_realm(LOG_REALM_SYSTEMD ) >= 7),0))) { | ||||
| 145 | _cleanup_free___attribute__((cleanup(freep))) char *cmd; | ||||
| 146 | |||||
| 147 | cmd = strv_join((char**) args, " "); | ||||
| 148 | log_debug("Executing \"%s\"...", strnull(cmd))({ int _level = (((7))), _e = ((0)), _realm = (LOG_REALM_SYSTEMD ); (log_get_max_level_realm(_realm) >= ((_level) & 0x07 )) ? log_internal_realm(((_realm) << 10 | (_level)), _e , "../src/vconsole/vconsole-setup.c", 148, __func__, "Executing \"%s\"..." , strnull(cmd)) : -abs(_e); }); | ||||
| 149 | } | ||||
| 150 | |||||
| 151 | r = safe_fork("(loadkeys)", FORK_RESET_SIGNALS|FORK_CLOSE_ALL_FDS|FORK_LOG, &pid); | ||||
| 152 | if (r < 0) | ||||
| 153 | return r; | ||||
| 154 | if (r == 0) { | ||||
| 155 | execv(args[0], (char **) args); | ||||
| 156 | _exit(EXIT_FAILURE1); | ||||
| 157 | } | ||||
| 158 | |||||
| 159 | return wait_for_terminate_and_check(KBD_LOADKEYS"/bin/loadkeys", pid, WAIT_LOG); | ||||
| 160 | } | ||||
| 161 | |||||
| 162 | static int font_load_and_wait(const char *vc, const char *font, const char *map, const char *unimap) { | ||||
| 163 | const char *args[9]; | ||||
| 164 | unsigned i = 0; | ||||
| 165 | pid_t pid; | ||||
| 166 | int r; | ||||
| 167 | |||||
| 168 | /* Any part can be set independently */ | ||||
| 169 | if (isempty(font) && isempty(map) && isempty(unimap)) | ||||
| 170 | return 0; | ||||
| 171 | |||||
| 172 | args[i++] = KBD_SETFONT"/bin/setfont"; | ||||
| 173 | args[i++] = "-C"; | ||||
| 174 | args[i++] = vc; | ||||
| 175 | if (!isempty(map)) { | ||||
| 176 | args[i++] = "-m"; | ||||
| 177 | args[i++] = map; | ||||
| 178 | } | ||||
| 179 | if (!isempty(unimap)) { | ||||
| 180 | args[i++] = "-u"; | ||||
| 181 | args[i++] = unimap; | ||||
| 182 | } | ||||
| 183 | if (!isempty(font)) | ||||
| 184 | args[i++] = font; | ||||
| 185 | args[i++] = NULL((void*)0); | ||||
| 186 | |||||
| 187 | if (DEBUG_LOGGING(__builtin_expect(!!(log_get_max_level_realm(LOG_REALM_SYSTEMD ) >= 7),0))) { | ||||
| 188 | _cleanup_free___attribute__((cleanup(freep))) char *cmd; | ||||
| 189 | |||||
| 190 | cmd = strv_join((char**) args, " "); | ||||
| 191 | log_debug("Executing \"%s\"...", strnull(cmd))({ int _level = (((7))), _e = ((0)), _realm = (LOG_REALM_SYSTEMD ); (log_get_max_level_realm(_realm) >= ((_level) & 0x07 )) ? log_internal_realm(((_realm) << 10 | (_level)), _e , "../src/vconsole/vconsole-setup.c", 191, __func__, "Executing \"%s\"..." , strnull(cmd)) : -abs(_e); }); | ||||
| 192 | } | ||||
| 193 | |||||
| 194 | r = safe_fork("(setfont)", FORK_RESET_SIGNALS|FORK_CLOSE_ALL_FDS|FORK_LOG, &pid); | ||||
| 195 | if (r < 0) | ||||
| 196 | return r; | ||||
| 197 | if (r == 0) { | ||||
| 198 | execv(args[0], (char **) args); | ||||
| 199 | _exit(EXIT_FAILURE1); | ||||
| 200 | } | ||||
| 201 | |||||
| 202 | return wait_for_terminate_and_check(KBD_SETFONT"/bin/setfont", pid, WAIT_LOG); | ||||
| 203 | } | ||||
| 204 | |||||
| 205 | /* | ||||
| 206 | * A newly allocated VT uses the font from the source VT. Here | ||||
| 207 | * we update all possibly already allocated VTs with the configured | ||||
| 208 | * font. It also allows to restart systemd-vconsole-setup.service, | ||||
| 209 | * to apply a new font to all VTs. | ||||
| 210 | * | ||||
| 211 | * We also setup per-console utf8 related stuff: kbdmode, term | ||||
| 212 | * processing, stty iutf8. | ||||
| 213 | */ | ||||
| 214 | static void setup_remaining_vcs(int src_fd, unsigned src_idx, bool_Bool utf8) { | ||||
| 215 | struct console_font_op cfo = { | ||||
| 216 | .op = KD_FONT_OP_GET1, | ||||
| 217 | .width = UINT_MAX(2147483647 *2U +1U), .height = UINT_MAX(2147483647 *2U +1U), | ||||
| 218 | .charcount = UINT_MAX(2147483647 *2U +1U), | ||||
| 219 | }; | ||||
| 220 | struct unimapinit adv = {}; | ||||
| 221 | struct unimapdesc unimapd; | ||||
| 222 | _cleanup_free___attribute__((cleanup(freep))) struct unipair* unipairs = NULL((void*)0); | ||||
| 223 | _cleanup_free___attribute__((cleanup(freep))) void *fontbuf = NULL((void*)0); | ||||
| 224 | unsigned i; | ||||
| 225 | int log_level; | ||||
| 226 | int r; | ||||
| 227 | |||||
| 228 | unipairs = new(struct unipair, USHRT_MAX)((struct unipair*) malloc_multiply(sizeof(struct unipair), (( 32767 *2 +1)))); | ||||
| 229 | if (!unipairs) { | ||||
| 230 | log_oom()log_oom_internal(LOG_REALM_SYSTEMD, "../src/vconsole/vconsole-setup.c" , 230, __func__); | ||||
| 231 | return; | ||||
| 232 | } | ||||
| 233 | |||||
| 234 | log_level = LOG_WARNING4; | ||||
| 235 | |||||
| 236 | /* get metadata of the current font (width, height, count) */ | ||||
| 237 | r = ioctl(src_fd, KDFONTOP0x4B72, &cfo); | ||||
| 238 | if (r < 0) { | ||||
| 239 | /* We might be called to operate on the dummy console (to setup keymap | ||||
| 240 | * mainly) when fbcon deferred takeover is used for example. In such case, | ||||
| 241 | * setting font is not supported and is expected to fail. */ | ||||
| 242 | if (errno(*__errno_location ()) == ENOSYS38) | ||||
| |||||
| 243 | log_level = LOG_DEBUG7; | ||||
| 244 | |||||
| 245 | log_full_errno(log_level, errno,({ int _level = ((log_level)), _e = (((*__errno_location ())) ), _realm = (LOG_REALM_SYSTEMD); (log_get_max_level_realm(_realm ) >= ((_level) & 0x07)) ? log_internal_realm(((_realm) << 10 | (_level)), _e, "../src/vconsole/vconsole-setup.c" , 246, __func__, "KD_FONT_OP_GET failed while trying to get the font metadata: %m" ) : -abs(_e); }) | ||||
| 246 | "KD_FONT_OP_GET failed while trying to get the font metadata: %m")({ int _level = ((log_level)), _e = (((*__errno_location ())) ), _realm = (LOG_REALM_SYSTEMD); (log_get_max_level_realm(_realm ) >= ((_level) & 0x07)) ? log_internal_realm(((_realm) << 10 | (_level)), _e, "../src/vconsole/vconsole-setup.c" , 246, __func__, "KD_FONT_OP_GET failed while trying to get the font metadata: %m" ) : -abs(_e); }); | ||||
| 247 | } else { | ||||
| 248 | /* verify parameter sanity first */ | ||||
| 249 | if (cfo.width > 32 || cfo.height > 32 || cfo.charcount > 512) | ||||
| 250 | log_warning("Invalid font metadata - width: %u (max 32), height: %u (max 32), count: %u (max 512)",({ int _level = (((4))), _e = ((0)), _realm = (LOG_REALM_SYSTEMD ); (log_get_max_level_realm(_realm) >= ((_level) & 0x07 )) ? log_internal_realm(((_realm) << 10 | (_level)), _e , "../src/vconsole/vconsole-setup.c", 251, __func__, "Invalid font metadata - width: %u (max 32), height: %u (max 32), count: %u (max 512)" , cfo.width, cfo.height, cfo.charcount) : -abs(_e); }) | ||||
| 251 | cfo.width, cfo.height, cfo.charcount)({ int _level = (((4))), _e = ((0)), _realm = (LOG_REALM_SYSTEMD ); (log_get_max_level_realm(_realm) >= ((_level) & 0x07 )) ? log_internal_realm(((_realm) << 10 | (_level)), _e , "../src/vconsole/vconsole-setup.c", 251, __func__, "Invalid font metadata - width: %u (max 32), height: %u (max 32), count: %u (max 512)" , cfo.width, cfo.height, cfo.charcount) : -abs(_e); }); | ||||
| 252 | else { | ||||
| 253 | /* | ||||
| 254 | * Console fonts supported by the kernel are limited in size to 32 x 32 and maximum 512 | ||||
| 255 | * characters. Thus with 1 bit per pixel it requires up to 65536 bytes. The height always | ||||
| 256 | * requries 32 per glyph, regardless of the actual height - see the comment above #define | ||||
| 257 | * max_font_size 65536 in drivers/tty/vt/vt.c for more details. | ||||
| 258 | */ | ||||
| 259 | fontbuf = malloc_multiply((cfo.width + 7) / 8 * 32, cfo.charcount); | ||||
| 260 | if (!fontbuf) { | ||||
| 261 | log_oom()log_oom_internal(LOG_REALM_SYSTEMD, "../src/vconsole/vconsole-setup.c" , 261, __func__); | ||||
| 262 | return; | ||||
| 263 | } | ||||
| 264 | /* get fonts from the source console */ | ||||
| 265 | cfo.data = fontbuf; | ||||
| 266 | r = ioctl(src_fd, KDFONTOP0x4B72, &cfo); | ||||
| 267 | if (r < 0) | ||||
| 268 | log_warning_errno(errno, "KD_FONT_OP_GET failed while trying to read the font data: %m")({ int _level = ((4)), _e = (((*__errno_location ()))), _realm = (LOG_REALM_SYSTEMD); (log_get_max_level_realm(_realm) >= ((_level) & 0x07)) ? log_internal_realm(((_realm) << 10 | (_level)), _e, "../src/vconsole/vconsole-setup.c", 268, __func__, "KD_FONT_OP_GET failed while trying to read the font data: %m" ) : -abs(_e); }); | ||||
| 269 | else { | ||||
| 270 | unimapd.entries = unipairs; | ||||
| 271 | unimapd.entry_ct = USHRT_MAX(32767 *2 +1); | ||||
| 272 | r = ioctl(src_fd, GIO_UNIMAP0x4B66, &unimapd); | ||||
| 273 | if (r < 0) | ||||
| 274 | log_warning_errno(errno, "GIO_UNIMAP failed while trying to read unicode mappings: %m")({ int _level = ((4)), _e = (((*__errno_location ()))), _realm = (LOG_REALM_SYSTEMD); (log_get_max_level_realm(_realm) >= ((_level) & 0x07)) ? log_internal_realm(((_realm) << 10 | (_level)), _e, "../src/vconsole/vconsole-setup.c", 274, __func__, "GIO_UNIMAP failed while trying to read unicode mappings: %m" ) : -abs(_e); }); | ||||
| 275 | else | ||||
| 276 | cfo.op = KD_FONT_OP_SET0; | ||||
| 277 | } | ||||
| 278 | } | ||||
| 279 | } | ||||
| 280 | |||||
| 281 | if (cfo.op != KD_FONT_OP_SET0) | ||||
| 282 | log_full(log_level, "Fonts will not be copied to remaining consoles")({ int _level = (((log_level))), _e = ((0)), _realm = (LOG_REALM_SYSTEMD ); (log_get_max_level_realm(_realm) >= ((_level) & 0x07 )) ? log_internal_realm(((_realm) << 10 | (_level)), _e , "../src/vconsole/vconsole-setup.c", 282, __func__, "Fonts will not be copied to remaining consoles" ) : -abs(_e); }); | ||||
| 283 | |||||
| 284 | for (i = 1; i <= 63; i++) { | ||||
| 285 | char ttyname[sizeof("/dev/tty63")]; | ||||
| 286 | _cleanup_close___attribute__((cleanup(closep))) int fd_d = -1; | ||||
| 287 | |||||
| 288 | if (i == src_idx || verify_vc_allocation(i) < 0) | ||||
| 289 | continue; | ||||
| 290 | |||||
| 291 | /* try to open terminal */ | ||||
| 292 | xsprintf(ttyname, "/dev/tty%u", i)do { if ((__builtin_expect(!!(!(((size_t) snprintf(ttyname, __extension__ (__builtin_choose_expr( !__builtin_types_compatible_p(typeof (ttyname), typeof(&*(ttyname))), sizeof(ttyname)/sizeof(( ttyname)[0]), ((void)0))), "/dev/tty%u", i) < (__extension__ (__builtin_choose_expr( !__builtin_types_compatible_p(typeof (ttyname), typeof(&*(ttyname))), sizeof(ttyname)/sizeof(( ttyname)[0]), ((void)0))))))),0))) log_assert_failed_realm(LOG_REALM_SYSTEMD , ("xsprintf: " "ttyname" "[] must be big enough"), "../src/vconsole/vconsole-setup.c" , 292, __PRETTY_FUNCTION__); } while (0); | ||||
| 293 | fd_d = open_terminal(ttyname, O_RDWR02|O_CLOEXEC02000000|O_NOCTTY0400); | ||||
| 294 | if (fd_d < 0) { | ||||
| 295 | log_warning_errno(fd_d, "Unable to open tty%u, fonts will not be copied: %m", i)({ int _level = ((4)), _e = ((fd_d)), _realm = (LOG_REALM_SYSTEMD ); (log_get_max_level_realm(_realm) >= ((_level) & 0x07 )) ? log_internal_realm(((_realm) << 10 | (_level)), _e , "../src/vconsole/vconsole-setup.c", 295, __func__, "Unable to open tty%u, fonts will not be copied: %m" , i) : -abs(_e); }); | ||||
| 296 | continue; | ||||
| 297 | } | ||||
| 298 | |||||
| 299 | if (verify_vc_kbmode(fd_d) < 0) | ||||
| 300 | continue; | ||||
| 301 | |||||
| 302 | toggle_utf8(ttyname, fd_d, utf8); | ||||
| 303 | |||||
| 304 | if (cfo.op != KD_FONT_OP_SET0) | ||||
| 305 | continue; | ||||
| 306 | |||||
| 307 | r = ioctl(fd_d, KDFONTOP0x4B72, &cfo); | ||||
| 308 | if (r < 0) { | ||||
| 309 | log_warning_errno(errno, "KD_FONT_OP_SET failed, fonts will not be copied to tty%u: %m", i)({ int _level = ((4)), _e = (((*__errno_location ()))), _realm = (LOG_REALM_SYSTEMD); (log_get_max_level_realm(_realm) >= ((_level) & 0x07)) ? log_internal_realm(((_realm) << 10 | (_level)), _e, "../src/vconsole/vconsole-setup.c", 309, __func__, "KD_FONT_OP_SET failed, fonts will not be copied to tty%u: %m" , i) : -abs(_e); }); | ||||
| 310 | continue; | ||||
| 311 | } | ||||
| 312 | |||||
| 313 | /* | ||||
| 314 | * copy unicode translation table | ||||
| 315 | * unimapd is a ushort count and a pointer to an | ||||
| 316 | * array of struct unipair { ushort, ushort } | ||||
| 317 | */ | ||||
| 318 | r = ioctl(fd_d, PIO_UNIMAPCLR0x4B68, &adv); | ||||
| 319 | if (r < 0) { | ||||
| 320 | log_warning_errno(errno, "PIO_UNIMAPCLR failed, unimaps might be incorrect for tty%u: %m", i)({ int _level = ((4)), _e = (((*__errno_location ()))), _realm = (LOG_REALM_SYSTEMD); (log_get_max_level_realm(_realm) >= ((_level) & 0x07)) ? log_internal_realm(((_realm) << 10 | (_level)), _e, "../src/vconsole/vconsole-setup.c", 320, __func__, "PIO_UNIMAPCLR failed, unimaps might be incorrect for tty%u: %m" , i) : -abs(_e); }); | ||||
| 321 | continue; | ||||
| 322 | } | ||||
| 323 | |||||
| 324 | r = ioctl(fd_d, PIO_UNIMAP0x4B67, &unimapd); | ||||
| 325 | if (r < 0) { | ||||
| 326 | log_warning_errno(errno, "PIO_UNIMAP failed, unimaps might be incorrect for tty%u: %m", i)({ int _level = ((4)), _e = (((*__errno_location ()))), _realm = (LOG_REALM_SYSTEMD); (log_get_max_level_realm(_realm) >= ((_level) & 0x07)) ? log_internal_realm(((_realm) << 10 | (_level)), _e, "../src/vconsole/vconsole-setup.c", 326, __func__, "PIO_UNIMAP failed, unimaps might be incorrect for tty%u: %m" , i) : -abs(_e); }); | ||||
| 327 | continue; | ||||
| 328 | } | ||||
| 329 | |||||
| 330 | log_debug("Font and unimap successfully copied to %s", ttyname)({ int _level = (((7))), _e = ((0)), _realm = (LOG_REALM_SYSTEMD ); (log_get_max_level_realm(_realm) >= ((_level) & 0x07 )) ? log_internal_realm(((_realm) << 10 | (_level)), _e , "../src/vconsole/vconsole-setup.c", 330, __func__, "Font and unimap successfully copied to %s" , ttyname) : -abs(_e); }); | ||||
| 331 | } | ||||
| 332 | } | ||||
| 333 | |||||
| 334 | static int find_source_vc(char **ret_path, unsigned *ret_idx) { | ||||
| 335 | _cleanup_free___attribute__((cleanup(freep))) char *path = NULL((void*)0); | ||||
| 336 | int r, err = 0; | ||||
| 337 | unsigned i; | ||||
| 338 | |||||
| 339 | path = new(char, sizeof("/dev/tty63"))((char*) malloc_multiply(sizeof(char), (sizeof("/dev/tty63")) )); | ||||
| 340 | if (!path) | ||||
| 341 | return log_oom()log_oom_internal(LOG_REALM_SYSTEMD, "../src/vconsole/vconsole-setup.c" , 341, __func__); | ||||
| 342 | |||||
| 343 | for (i = 1; i <= 63; i++) { | ||||
| 344 | _cleanup_close___attribute__((cleanup(closep))) int fd = -1; | ||||
| 345 | |||||
| 346 | r = verify_vc_allocation(i); | ||||
| 347 | if (r < 0) { | ||||
| 348 | if (!err) | ||||
| 349 | err = -r; | ||||
| 350 | continue; | ||||
| 351 | } | ||||
| 352 | |||||
| 353 | sprintf(path, "/dev/tty%u", i); | ||||
| 354 | fd = open_terminal(path, O_RDWR02|O_CLOEXEC02000000|O_NOCTTY0400); | ||||
| 355 | if (fd < 0) { | ||||
| 356 | if (!err) | ||||
| 357 | err = -fd; | ||||
| 358 | continue; | ||||
| 359 | } | ||||
| 360 | r = verify_vc_kbmode(fd); | ||||
| 361 | if (r < 0) { | ||||
| 362 | if (!err) | ||||
| 363 | err = -r; | ||||
| 364 | continue; | ||||
| 365 | } | ||||
| 366 | |||||
| 367 | /* all checks passed, return this one as a source console */ | ||||
| 368 | *ret_idx = i; | ||||
| 369 | *ret_path = TAKE_PTR(path)({ typeof(path) _ptr_ = (path); (path) = ((void*)0); _ptr_; } ); | ||||
| 370 | return TAKE_FD(fd)({ int _fd_ = (fd); (fd) = -1; _fd_; }); | ||||
| 371 | } | ||||
| 372 | |||||
| 373 | return log_error_errno(err, "No usable source console found: %m")({ int _level = ((3)), _e = ((err)), _realm = (LOG_REALM_SYSTEMD ); (log_get_max_level_realm(_realm) >= ((_level) & 0x07 )) ? log_internal_realm(((_realm) << 10 | (_level)), _e , "../src/vconsole/vconsole-setup.c", 373, __func__, "No usable source console found: %m" ) : -abs(_e); }); | ||||
| 374 | } | ||||
| 375 | |||||
| 376 | static int verify_source_vc(char **ret_path, const char *src_vc) { | ||||
| 377 | _cleanup_close___attribute__((cleanup(closep))) int fd = -1; | ||||
| 378 | char *path; | ||||
| 379 | int r; | ||||
| 380 | |||||
| 381 | fd = open_terminal(src_vc, O_RDWR02|O_CLOEXEC02000000|O_NOCTTY0400); | ||||
| 382 | if (fd < 0) | ||||
| 383 | return log_error_errno(fd, "Failed to open %s: %m", src_vc)({ int _level = ((3)), _e = ((fd)), _realm = (LOG_REALM_SYSTEMD ); (log_get_max_level_realm(_realm) >= ((_level) & 0x07 )) ? log_internal_realm(((_realm) << 10 | (_level)), _e , "../src/vconsole/vconsole-setup.c", 383, __func__, "Failed to open %s: %m" , src_vc) : -abs(_e); }); | ||||
| 384 | |||||
| 385 | r = verify_vc_device(fd); | ||||
| 386 | if (r < 0) | ||||
| 387 | return log_error_errno(r, "Device %s is not a virtual console: %m", src_vc)({ int _level = ((3)), _e = ((r)), _realm = (LOG_REALM_SYSTEMD ); (log_get_max_level_realm(_realm) >= ((_level) & 0x07 )) ? log_internal_realm(((_realm) << 10 | (_level)), _e , "../src/vconsole/vconsole-setup.c", 387, __func__, "Device %s is not a virtual console: %m" , src_vc) : -abs(_e); }); | ||||
| 388 | |||||
| 389 | r = verify_vc_allocation_byfd(fd); | ||||
| 390 | if (r < 0) | ||||
| 391 | return log_error_errno(r, "Virtual console %s is not allocated: %m", src_vc)({ int _level = ((3)), _e = ((r)), _realm = (LOG_REALM_SYSTEMD ); (log_get_max_level_realm(_realm) >= ((_level) & 0x07 )) ? log_internal_realm(((_realm) << 10 | (_level)), _e , "../src/vconsole/vconsole-setup.c", 391, __func__, "Virtual console %s is not allocated: %m" , src_vc) : -abs(_e); }); | ||||
| 392 | |||||
| 393 | r = verify_vc_kbmode(fd); | ||||
| 394 | if (r < 0) | ||||
| 395 | return log_error_errno(r, "Virtual console %s is not in K_XLATE or K_UNICODE: %m", src_vc)({ int _level = ((3)), _e = ((r)), _realm = (LOG_REALM_SYSTEMD ); (log_get_max_level_realm(_realm) >= ((_level) & 0x07 )) ? log_internal_realm(((_realm) << 10 | (_level)), _e , "../src/vconsole/vconsole-setup.c", 395, __func__, "Virtual console %s is not in K_XLATE or K_UNICODE: %m" , src_vc) : -abs(_e); }); | ||||
| 396 | |||||
| 397 | path = strdup(src_vc); | ||||
| 398 | if (!path) | ||||
| 399 | return log_oom()log_oom_internal(LOG_REALM_SYSTEMD, "../src/vconsole/vconsole-setup.c" , 399, __func__); | ||||
| 400 | |||||
| 401 | *ret_path = path; | ||||
| 402 | return TAKE_FD(fd)({ int _fd_ = (fd); (fd) = -1; _fd_; }); | ||||
| 403 | } | ||||
| 404 | |||||
| 405 | int main(int argc, char **argv) { | ||||
| 406 | _cleanup_free___attribute__((cleanup(freep))) char | ||||
| 407 | *vc = NULL((void*)0), | ||||
| 408 | *vc_keymap = NULL((void*)0), *vc_keymap_toggle = NULL((void*)0), | ||||
| 409 | *vc_font = NULL((void*)0), *vc_font_map = NULL((void*)0), *vc_font_unimap = NULL((void*)0); | ||||
| 410 | _cleanup_close___attribute__((cleanup(closep))) int fd = -1; | ||||
| 411 | bool_Bool utf8, keyboard_ok; | ||||
| 412 | unsigned idx = 0; | ||||
| 413 | int r; | ||||
| 414 | |||||
| 415 | log_set_target(LOG_TARGET_AUTO); | ||||
| 416 | log_parse_environment()log_parse_environment_realm(LOG_REALM_SYSTEMD); | ||||
| 417 | log_open(); | ||||
| 418 | |||||
| 419 | umask(0022); | ||||
| 420 | |||||
| 421 | if (argv[1]) | ||||
| |||||
| 422 | fd = verify_source_vc(&vc, argv[1]); | ||||
| 423 | else | ||||
| 424 | fd = find_source_vc(&vc, &idx); | ||||
| 425 | if (fd
| ||||
| 426 | return EXIT_FAILURE1; | ||||
| 427 | |||||
| 428 | utf8 = is_locale_utf8(); | ||||
| 429 | |||||
| 430 | r = parse_env_file(NULL((void*)0), "/etc/vconsole.conf", NEWLINE"\n\r", | ||||
| 431 | "KEYMAP", &vc_keymap, | ||||
| 432 | "KEYMAP_TOGGLE", &vc_keymap_toggle, | ||||
| 433 | "FONT", &vc_font, | ||||
| 434 | "FONT_MAP", &vc_font_map, | ||||
| 435 | "FONT_UNIMAP", &vc_font_unimap, | ||||
| 436 | NULL((void*)0)); | ||||
| 437 | if (r < 0 && r != -ENOENT2) | ||||
| 438 | log_warning_errno(r, "Failed to read /etc/vconsole.conf: %m")({ int _level = ((4)), _e = ((r)), _realm = (LOG_REALM_SYSTEMD ); (log_get_max_level_realm(_realm) >= ((_level) & 0x07 )) ? log_internal_realm(((_realm) << 10 | (_level)), _e , "../src/vconsole/vconsole-setup.c", 438, __func__, "Failed to read /etc/vconsole.conf: %m" ) : -abs(_e); }); | ||||
| 439 | |||||
| 440 | /* Let the kernel command line override /etc/vconsole.conf */ | ||||
| 441 | if (detect_container() <= 0) { | ||||
| 442 | r = parse_env_file(NULL((void*)0), "/proc/cmdline", WHITESPACE" \t\n\r", | ||||
| 443 | "vconsole.keymap", &vc_keymap, | ||||
| 444 | "vconsole.keymap_toggle", &vc_keymap_toggle, | ||||
| 445 | "vconsole.font", &vc_font, | ||||
| 446 | "vconsole.font_map", &vc_font_map, | ||||
| 447 | "vconsole.font_unimap", &vc_font_unimap, | ||||
| 448 | /* compatibility with obsolete multiple-dot scheme */ | ||||
| 449 | "vconsole.keymap.toggle", &vc_keymap_toggle, | ||||
| 450 | "vconsole.font.map", &vc_font_map, | ||||
| 451 | "vconsole.font.unimap", &vc_font_unimap, | ||||
| 452 | NULL((void*)0)); | ||||
| 453 | if (r < 0 && r != -ENOENT2) | ||||
| 454 | log_warning_errno(r, "Failed to read /proc/cmdline: %m")({ int _level = ((4)), _e = ((r)), _realm = (LOG_REALM_SYSTEMD ); (log_get_max_level_realm(_realm) >= ((_level) & 0x07 )) ? log_internal_realm(((_realm) << 10 | (_level)), _e , "../src/vconsole/vconsole-setup.c", 454, __func__, "Failed to read /proc/cmdline: %m" ) : -abs(_e); }); | ||||
| 455 | } | ||||
| 456 | |||||
| 457 | (void) toggle_utf8_sysfs(utf8); | ||||
| 458 | (void) toggle_utf8(vc, fd, utf8); | ||||
| 459 | |||||
| 460 | r = font_load_and_wait(vc, vc_font, vc_font_map, vc_font_unimap); | ||||
| 461 | keyboard_ok = keyboard_load_and_wait(vc, vc_keymap, vc_keymap_toggle, utf8) == 0; | ||||
| 462 | |||||
| 463 | if (idx
| ||||
| 464 | if (r == 0) | ||||
| 465 | setup_remaining_vcs(fd, idx, utf8); | ||||
| 466 | else if (r == EX_OSERR71) | ||||
| 467 | /* setfont returns EX_OSERR when ioctl(KDFONTOP/PIO_FONTX/PIO_FONTX) fails. | ||||
| 468 | * This might mean various things, but in particular lack of a graphical | ||||
| 469 | * console. Let's be generous and not treat this as an error. */ | ||||
| 470 | log_notice("Setting fonts failed with a \"system error\", ignoring.")({ int _level = (((5))), _e = ((0)), _realm = (LOG_REALM_SYSTEMD ); (log_get_max_level_realm(_realm) >= ((_level) & 0x07 )) ? log_internal_realm(((_realm) << 10 | (_level)), _e , "../src/vconsole/vconsole-setup.c", 470, __func__, "Setting fonts failed with a \"system error\", ignoring." ) : -abs(_e); }); | ||||
| 471 | else | ||||
| 472 | log_warning("Setting source virtual console failed, ignoring remaining ones")({ int _level = (((4))), _e = ((0)), _realm = (LOG_REALM_SYSTEMD ); (log_get_max_level_realm(_realm) >= ((_level) & 0x07 )) ? log_internal_realm(((_realm) << 10 | (_level)), _e , "../src/vconsole/vconsole-setup.c", 472, __func__, "Setting source virtual console failed, ignoring remaining ones" ) : -abs(_e); }); | ||||
| 473 | } | ||||
| 474 | |||||
| 475 | return IN_SET(r, 0, EX_OSERR)({ _Bool _found = 0; static __attribute__ ((unused)) char _static_assert__macros_need_to_be_extended [20 - sizeof((int[]){0, 71})/sizeof(int)]; switch(r) { case 0 : case 71: _found = 1; break; default: break; } _found; }) && keyboard_ok ? EXIT_SUCCESS0 : EXIT_FAILURE1; | ||||
| 476 | } |
| 1 | /* SPDX-License-Identifier: LGPL-2.1+ */ |
| 2 | #pragma once |
| 3 | |
| 4 | #include <alloca.h> |
| 5 | #include <stddef.h> |
| 6 | #include <stdlib.h> |
| 7 | #include <string.h> |
| 8 | |
| 9 | #include "macro.h" |
| 10 | |
| 11 | #define new(t, n)((t*) malloc_multiply(sizeof(t), (n))) ((t*) malloc_multiply(sizeof(t), (n))) |
| 12 | |
| 13 | #define new0(t, n)((t*) calloc((n), sizeof(t))) ((t*) calloc((n), sizeof(t))) |
| 14 | |
| 15 | #define newa(t, n)({ do { if ((__builtin_expect(!!(!(!size_multiply_overflow(sizeof (t), n))),0))) log_assert_failed_realm(LOG_REALM_SYSTEMD, ("!size_multiply_overflow(sizeof(t), n)" ), "../src/basic/alloc-util.h", 15, __PRETTY_FUNCTION__); } while (0); (t*) __builtin_alloca (sizeof(t)*(n)); }) \ |
| 16 | ({ \ |
| 17 | assert(!size_multiply_overflow(sizeof(t), n))do { if ((__builtin_expect(!!(!(!size_multiply_overflow(sizeof (t), n))),0))) log_assert_failed_realm(LOG_REALM_SYSTEMD, ("!size_multiply_overflow(sizeof(t), n)" ), "../src/basic/alloc-util.h", 17, __PRETTY_FUNCTION__); } while (0); \ |
| 18 | (t*) alloca(sizeof(t)*(n))__builtin_alloca (sizeof(t)*(n)); \ |
| 19 | }) |
| 20 | |
| 21 | #define newa0(t, n)({ do { if ((__builtin_expect(!!(!(!size_multiply_overflow(sizeof (t), n))),0))) log_assert_failed_realm(LOG_REALM_SYSTEMD, ("!size_multiply_overflow(sizeof(t), n)" ), "../src/basic/alloc-util.h", 21, __PRETTY_FUNCTION__); } while (0); (t*) ({ char *_new_; size_t _len_ = sizeof(t)*(n); _new_ = __builtin_alloca (_len_); (void *) memset(_new_, 0, _len_) ; }); }) \ |
| 22 | ({ \ |
| 23 | assert(!size_multiply_overflow(sizeof(t), n))do { if ((__builtin_expect(!!(!(!size_multiply_overflow(sizeof (t), n))),0))) log_assert_failed_realm(LOG_REALM_SYSTEMD, ("!size_multiply_overflow(sizeof(t), n)" ), "../src/basic/alloc-util.h", 23, __PRETTY_FUNCTION__); } while (0); \ |
| 24 | (t*) alloca0(sizeof(t)*(n))({ char *_new_; size_t _len_ = sizeof(t)*(n); _new_ = __builtin_alloca (_len_); (void *) memset(_new_, 0, _len_); }); \ |
| 25 | }) |
| 26 | |
| 27 | #define newdup(t, p, n)((t*) memdup_multiply(p, sizeof(t), (n))) ((t*) memdup_multiply(p, sizeof(t), (n))) |
| 28 | |
| 29 | #define newdup_suffix0(t, p, n)((t*) memdup_suffix0_multiply(p, sizeof(t), (n))) ((t*) memdup_suffix0_multiply(p, sizeof(t), (n))) |
| 30 | |
| 31 | #define malloc0(n)(calloc(1, (n))) (calloc(1, (n))) |
| 32 | |
| 33 | static inline void *mfree(void *memory) { |
| 34 | free(memory); |
| 35 | return NULL((void*)0); |
| 36 | } |
| 37 | |
| 38 | #define free_and_replace(a, b)({ free(a); (a) = (b); (b) = ((void*)0); 0; }) \ |
| 39 | ({ \ |
| 40 | free(a); \ |
| 41 | (a) = (b); \ |
| 42 | (b) = NULL((void*)0); \ |
| 43 | 0; \ |
| 44 | }) |
| 45 | |
| 46 | void* memdup(const void *p, size_t l) _alloc_(2); |
| 47 | void* memdup_suffix0(const void *p, size_t l) _alloc_(2); |
| 48 | |
| 49 | static inline void freep(void *p) { |
| 50 | free(*(void**) p); |
| 51 | } |
| 52 | |
| 53 | #define _cleanup_free___attribute__((cleanup(freep))) _cleanup_(freep)__attribute__((cleanup(freep))) |
| 54 | |
| 55 | static inline bool_Bool size_multiply_overflow(size_t size, size_t need) { |
| 56 | return _unlikely_(need != 0 && size > (SIZE_MAX / need))(__builtin_expect(!!(need != 0 && size > ((18446744073709551615UL ) / need)),0)); |
| 57 | } |
| 58 | |
| 59 | _malloc___attribute__ ((malloc)) _alloc_(1, 2) static inline void *malloc_multiply(size_t size, size_t need) { |
| 60 | if (size_multiply_overflow(size, need)) |
| 61 | return NULL((void*)0); |
| 62 | |
| 63 | return malloc(size * need); |
| 64 | } |
| 65 | |
| 66 | #if !HAVE_REALLOCARRAY1 |
| 67 | _alloc_(2, 3) static inline void *reallocarray(void *p, size_t need, size_t size) { |
| 68 | if (size_multiply_overflow(size, need)) |
| 69 | return NULL((void*)0); |
| 70 | |
| 71 | return realloc(p, size * need); |
| 72 | } |
| 73 | #endif |
| 74 | |
| 75 | _alloc_(2, 3) static inline void *memdup_multiply(const void *p, size_t size, size_t need) { |
| 76 | if (size_multiply_overflow(size, need)) |
| 77 | return NULL((void*)0); |
| 78 | |
| 79 | return memdup(p, size * need); |
| 80 | } |
| 81 | |
| 82 | _alloc_(2, 3) static inline void *memdup_suffix0_multiply(const void *p, size_t size, size_t need) { |
| 83 | if (size_multiply_overflow(size, need)) |
| 84 | return NULL((void*)0); |
| 85 | |
| 86 | return memdup_suffix0(p, size * need); |
| 87 | } |
| 88 | |
| 89 | void* greedy_realloc(void **p, size_t *allocated, size_t need, size_t size); |
| 90 | void* greedy_realloc0(void **p, size_t *allocated, size_t need, size_t size); |
| 91 | |
| 92 | #define GREEDY_REALLOC(array, allocated, need)greedy_realloc((void**) &(array), &(allocated), (need ), sizeof((array)[0])) \ |
| 93 | greedy_realloc((void**) &(array), &(allocated), (need), sizeof((array)[0])) |
| 94 | |
| 95 | #define GREEDY_REALLOC0(array, allocated, need)greedy_realloc0((void**) &(array), &(allocated), (need ), sizeof((array)[0])) \ |
| 96 | greedy_realloc0((void**) &(array), &(allocated), (need), sizeof((array)[0])) |
| 97 | |
| 98 | #define alloca0(n)({ char *_new_; size_t _len_ = n; _new_ = __builtin_alloca (_len_ ); (void *) memset(_new_, 0, _len_); }) \ |
| 99 | ({ \ |
| 100 | char *_new_; \ |
| 101 | size_t _len_ = n; \ |
| 102 | _new_ = alloca(_len_)__builtin_alloca (_len_); \ |
| 103 | (void *) memset(_new_, 0, _len_); \ |
| 104 | }) |
| 105 | |
| 106 | /* It's not clear what alignment glibc/gcc alloca() guarantee, hence provide a guaranteed safe version */ |
| 107 | #define alloca_align(size, align)({ void *_ptr_; size_t _mask_ = (align) - 1; _ptr_ = __builtin_alloca ((size) + _mask_); (void*)(((uintptr_t)_ptr_ + _mask_) & ~_mask_); }) \ |
| 108 | ({ \ |
| 109 | void *_ptr_; \ |
| 110 | size_t _mask_ = (align) - 1; \ |
| 111 | _ptr_ = alloca((size) + _mask_)__builtin_alloca ((size) + _mask_); \ |
| 112 | (void*)(((uintptr_t)_ptr_ + _mask_) & ~_mask_); \ |
| 113 | }) |
| 114 | |
| 115 | #define alloca0_align(size, align)({ void *_new_; size_t _size_ = (size); _new_ = ({ void *_ptr_ ; size_t _mask_ = ((align)) - 1; _ptr_ = __builtin_alloca ((_size_ ) + _mask_); (void*)(((uintptr_t)_ptr_ + _mask_) & ~_mask_ ); }); (void*)memset(_new_, 0, _size_); }) \ |
| 116 | ({ \ |
| 117 | void *_new_; \ |
| 118 | size_t _size_ = (size); \ |
| 119 | _new_ = alloca_align(_size_, (align))({ void *_ptr_; size_t _mask_ = ((align)) - 1; _ptr_ = __builtin_alloca ((_size_) + _mask_); (void*)(((uintptr_t)_ptr_ + _mask_) & ~_mask_); }); \ |
| 120 | (void*)memset(_new_, 0, _size_); \ |
| 121 | }) |
| 122 | |
| 123 | /* Takes inspiration from Rusts's Option::take() method: reads and returns a pointer, but at the same time resets it to |
| 124 | * NULL. See: https://doc.rust-lang.org/std/option/enum.Option.html#method.take */ |
| 125 | #define TAKE_PTR(ptr)({ typeof(ptr) _ptr_ = (ptr); (ptr) = ((void*)0); _ptr_; }) \ |
| 126 | ({ \ |
| 127 | typeof(ptr) _ptr_ = (ptr); \ |
| 128 | (ptr) = NULL((void*)0); \ |
| 129 | _ptr_; \ |
| 130 | }) |