1 /* $OpenBSD: ssh-pkcs11-helper.c,v 1.19 2019/06/06 05:13:13 otto Exp $ */ 2 /* 3 * Copyright (c) 2010 Markus Friedl. All rights reserved. 4 * 5 * Permission to use, copy, modify, and distribute this software for any 6 * purpose with or without fee is hereby granted, provided that the above 7 * copyright notice and this permission notice appear in all copies. 8 * 9 * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES 10 * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF 11 * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR 12 * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES 13 * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN 14 * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF 15 * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE. 16 */ 17 18 #include <sys/types.h> 19 #include <sys/queue.h> 20 #include <sys/time.h> 21 22 #include <errno.h> 23 #include <poll.h> 24 #include <stdarg.h> 25 #include <string.h> 26 #include <unistd.h> 27 28 #include "xmalloc.h" 29 #include "sshbuf.h" 30 #include "log.h" 31 #include "misc.h" 32 #include "sshkey.h" 33 #include "authfd.h" 34 #include "ssh-pkcs11.h" 35 #include "ssherr.h" 36 37 /* borrows code from sftp-server and ssh-agent */ 38 39 struct pkcs11_keyinfo { 40 struct sshkey *key; 41 char *providername; 42 TAILQ_ENTRY(pkcs11_keyinfo) next; 43 }; 44 45 TAILQ_HEAD(, pkcs11_keyinfo) pkcs11_keylist; 46 47 #define MAX_MSG_LENGTH 10240 /*XXX*/ 48 49 /* input and output queue */ 50 struct sshbuf *iqueue; 51 struct sshbuf *oqueue; 52 53 static void 54 add_key(struct sshkey *k, char *name) 55 { 56 struct pkcs11_keyinfo *ki; 57 58 ki = xcalloc(1, sizeof(*ki)); 59 ki->providername = xstrdup(name); 60 ki->key = k; 61 TAILQ_INSERT_TAIL(&pkcs11_keylist, ki, next); 62 } 63 64 static void 65 del_keys_by_name(char *name) 66 { 67 struct pkcs11_keyinfo *ki, *nxt; 68 69 for (ki = TAILQ_FIRST(&pkcs11_keylist); ki; ki = nxt) { 70 nxt = TAILQ_NEXT(ki, next); 71 if (!strcmp(ki->providername, name)) { 72 TAILQ_REMOVE(&pkcs11_keylist, ki, next); 73 free(ki->providername); 74 sshkey_free(ki->key); 75 free(ki); 76 } 77 } 78 } 79 80 /* lookup matching 'private' key */ 81 static struct sshkey * 82 lookup_key(struct sshkey *k) 83 { 84 struct pkcs11_keyinfo *ki; 85 86 TAILQ_FOREACH(ki, &pkcs11_keylist, next) { 87 debug("check %p %s", ki, ki->providername); 88 if (sshkey_equal(k, ki->key)) 89 return (ki->key); 90 } 91 return (NULL); 92 } 93 94 static void 95 send_msg(struct sshbuf *m) 96 { 97 int r; 98 99 if ((r = sshbuf_put_stringb(oqueue, m)) != 0) 100 fatal("%s: buffer error: %s", __func__, ssh_err(r)); 101 } 102 103 static void 104 process_add(void) 105 { 106 char *name, *pin; 107 struct sshkey **keys = NULL; 108 int r, i, nkeys; 109 u_char *blob; 110 size_t blen; 111 struct sshbuf *msg; 112 113 if ((msg = sshbuf_new()) == NULL) 114 fatal("%s: sshbuf_new failed", __func__); 115 if ((r = sshbuf_get_cstring(iqueue, &name, NULL)) != 0 || 116 (r = sshbuf_get_cstring(iqueue, &pin, NULL)) != 0) 117 fatal("%s: buffer error: %s", __func__, ssh_err(r)); 118 if ((nkeys = pkcs11_add_provider(name, pin, &keys)) > 0) { 119 if ((r = sshbuf_put_u8(msg, 120 SSH2_AGENT_IDENTITIES_ANSWER)) != 0 || 121 (r = sshbuf_put_u32(msg, nkeys)) != 0) 122 fatal("%s: buffer error: %s", __func__, ssh_err(r)); 123 for (i = 0; i < nkeys; i++) { 124 if ((r = sshkey_to_blob(keys[i], &blob, &blen)) != 0) { 125 debug("%s: sshkey_to_blob: %s", 126 __func__, ssh_err(r)); 127 continue; 128 } 129 if ((r = sshbuf_put_string(msg, blob, blen)) != 0 || 130 (r = sshbuf_put_cstring(msg, name)) != 0) 131 fatal("%s: buffer error: %s", 132 __func__, ssh_err(r)); 133 free(blob); 134 add_key(keys[i], name); 135 } 136 } else { 137 if ((r = sshbuf_put_u8(msg, SSH_AGENT_FAILURE)) != 0) 138 fatal("%s: buffer error: %s", __func__, ssh_err(r)); 139 if ((r = sshbuf_put_u32(msg, -nkeys)) != 0) 140 fatal("%s: buffer error: %s", __func__, ssh_err(r)); 141 } 142 free(keys); 143 free(pin); 144 free(name); 145 send_msg(msg); 146 sshbuf_free(msg); 147 } 148 149 static void 150 process_del(void) 151 { 152 char *name, *pin; 153 struct sshbuf *msg; 154 int r; 155 156 if ((msg = sshbuf_new()) == NULL) 157 fatal("%s: sshbuf_new failed", __func__); 158 if ((r = sshbuf_get_cstring(iqueue, &name, NULL)) != 0 || 159 (r = sshbuf_get_cstring(iqueue, &pin, NULL)) != 0) 160 fatal("%s: buffer error: %s", __func__, ssh_err(r)); 161 del_keys_by_name(name); 162 if ((r = sshbuf_put_u8(msg, pkcs11_del_provider(name) == 0 ? 163 SSH_AGENT_SUCCESS : SSH_AGENT_FAILURE)) != 0) 164 fatal("%s: buffer error: %s", __func__, ssh_err(r)); 165 free(pin); 166 free(name); 167 send_msg(msg); 168 sshbuf_free(msg); 169 } 170 171 static void 172 process_sign(void) 173 { 174 u_char *blob, *data, *signature = NULL; 175 size_t blen, dlen, slen = 0; 176 int r, ok = -1; 177 struct sshkey *key, *found; 178 struct sshbuf *msg; 179 180 /* XXX support SHA2 signature flags */ 181 if ((r = sshbuf_get_string(iqueue, &blob, &blen)) != 0 || 182 (r = sshbuf_get_string(iqueue, &data, &dlen)) != 0 || 183 (r = sshbuf_get_u32(iqueue, NULL)) != 0) 184 fatal("%s: buffer error: %s", __func__, ssh_err(r)); 185 186 if ((r = sshkey_from_blob(blob, blen, &key)) != 0) 187 error("%s: sshkey_from_blob: %s", __func__, ssh_err(r)); 188 else { 189 if ((found = lookup_key(key)) != NULL) { 190 #ifdef WITH_OPENSSL 191 int ret; 192 193 if (key->type == KEY_RSA) { 194 slen = RSA_size(key->rsa); 195 signature = xmalloc(slen); 196 ret = RSA_private_encrypt(dlen, data, signature, 197 found->rsa, RSA_PKCS1_PADDING); 198 if (ret != -1) { 199 slen = ret; 200 ok = 0; 201 } 202 } else if (key->type == KEY_ECDSA) { 203 u_int xslen = ECDSA_size(key->ecdsa); 204 205 signature = xmalloc(xslen); 206 /* "The parameter type is ignored." */ 207 ret = ECDSA_sign(-1, data, dlen, signature, 208 &xslen, found->ecdsa); 209 if (ret != 0) 210 ok = 0; 211 else 212 error("%s: ECDSA_sign" 213 " returns %d", __func__, ret); 214 slen = xslen; 215 } else 216 error("%s: don't know how to sign with key " 217 "type %d", __func__, (int)key->type); 218 #endif /* WITH_OPENSSL */ 219 } 220 sshkey_free(key); 221 } 222 if ((msg = sshbuf_new()) == NULL) 223 fatal("%s: sshbuf_new failed", __func__); 224 if (ok == 0) { 225 if ((r = sshbuf_put_u8(msg, SSH2_AGENT_SIGN_RESPONSE)) != 0 || 226 (r = sshbuf_put_string(msg, signature, slen)) != 0) 227 fatal("%s: buffer error: %s", __func__, ssh_err(r)); 228 } else { 229 if ((r = sshbuf_put_u8(msg, SSH2_AGENT_FAILURE)) != 0) 230 fatal("%s: buffer error: %s", __func__, ssh_err(r)); 231 } 232 free(data); 233 free(blob); 234 free(signature); 235 send_msg(msg); 236 sshbuf_free(msg); 237 } 238 239 static void 240 process(void) 241 { 242 u_int msg_len; 243 u_int buf_len; 244 u_int consumed; 245 u_char type; 246 const u_char *cp; 247 int r; 248 249 buf_len = sshbuf_len(iqueue); 250 if (buf_len < 5) 251 return; /* Incomplete message. */ 252 cp = sshbuf_ptr(iqueue); 253 msg_len = get_u32(cp); 254 if (msg_len > MAX_MSG_LENGTH) { 255 error("bad message len %d", msg_len); 256 cleanup_exit(11); 257 } 258 if (buf_len < msg_len + 4) 259 return; 260 if ((r = sshbuf_consume(iqueue, 4)) != 0 || 261 (r = sshbuf_get_u8(iqueue, &type)) != 0) 262 fatal("%s: buffer error: %s", __func__, ssh_err(r)); 263 buf_len -= 4; 264 switch (type) { 265 case SSH_AGENTC_ADD_SMARTCARD_KEY: 266 debug("process_add"); 267 process_add(); 268 break; 269 case SSH_AGENTC_REMOVE_SMARTCARD_KEY: 270 debug("process_del"); 271 process_del(); 272 break; 273 case SSH2_AGENTC_SIGN_REQUEST: 274 debug("process_sign"); 275 process_sign(); 276 break; 277 default: 278 error("Unknown message %d", type); 279 break; 280 } 281 /* discard the remaining bytes from the current packet */ 282 if (buf_len < sshbuf_len(iqueue)) { 283 error("iqueue grew unexpectedly"); 284 cleanup_exit(255); 285 } 286 consumed = buf_len - sshbuf_len(iqueue); 287 if (msg_len < consumed) { 288 error("msg_len %d < consumed %d", msg_len, consumed); 289 cleanup_exit(255); 290 } 291 if (msg_len > consumed) { 292 if ((r = sshbuf_consume(iqueue, msg_len - consumed)) != 0) 293 fatal("%s: buffer error: %s", __func__, ssh_err(r)); 294 } 295 } 296 297 void 298 cleanup_exit(int i) 299 { 300 /* XXX */ 301 _exit(i); 302 } 303 304 305 int 306 main(int argc, char **argv) 307 { 308 int r, ch, in, out, max, log_stderr = 0; 309 ssize_t len; 310 SyslogFacility log_facility = SYSLOG_FACILITY_AUTH; 311 LogLevel log_level = SYSLOG_LEVEL_ERROR; 312 char buf[4*4096]; 313 extern char *__progname; 314 struct pollfd pfd[2]; 315 316 TAILQ_INIT(&pkcs11_keylist); 317 318 log_init(__progname, log_level, log_facility, log_stderr); 319 320 while ((ch = getopt(argc, argv, "v")) != -1) { 321 switch (ch) { 322 case 'v': 323 log_stderr = 1; 324 if (log_level == SYSLOG_LEVEL_ERROR) 325 log_level = SYSLOG_LEVEL_DEBUG1; 326 else if (log_level < SYSLOG_LEVEL_DEBUG3) 327 log_level++; 328 break; 329 default: 330 fprintf(stderr, "usage: %s [-v]\n", __progname); 331 exit(1); 332 } 333 } 334 335 log_init(__progname, log_level, log_facility, log_stderr); 336 337 pkcs11_init(0); 338 in = STDIN_FILENO; 339 out = STDOUT_FILENO; 340 341 max = 0; 342 if (in > max) 343 max = in; 344 if (out > max) 345 max = out; 346 347 if ((iqueue = sshbuf_new()) == NULL) 348 fatal("%s: sshbuf_new failed", __func__); 349 if ((oqueue = sshbuf_new()) == NULL) 350 fatal("%s: sshbuf_new failed", __func__); 351 352 while (1) { 353 memset(pfd, 0, sizeof(pfd)); 354 pfd[0].fd = in; 355 pfd[1].fd = out; 356 357 /* 358 * Ensure that we can read a full buffer and handle 359 * the worst-case length packet it can generate, 360 * otherwise apply backpressure by stopping reads. 361 */ 362 if ((r = sshbuf_check_reserve(iqueue, sizeof(buf))) == 0 && 363 (r = sshbuf_check_reserve(oqueue, MAX_MSG_LENGTH)) == 0) 364 pfd[0].events = POLLIN; 365 else if (r != SSH_ERR_NO_BUFFER_SPACE) 366 fatal("%s: buffer error: %s", __func__, ssh_err(r)); 367 368 if (sshbuf_len(oqueue) > 0) 369 pfd[1].events = POLLOUT; 370 371 if ((r = poll(pfd, 2, -1 /* INFTIM */)) <= 0) { 372 if (r == 0 || errno == EINTR) 373 continue; 374 fatal("poll: %s", strerror(errno)); 375 } 376 377 /* copy stdin to iqueue */ 378 if ((pfd[0].revents & (POLLIN|POLLERR)) != 0) { 379 len = read(in, buf, sizeof buf); 380 if (len == 0) { 381 debug("read eof"); 382 cleanup_exit(0); 383 } else if (len < 0) { 384 error("read: %s", strerror(errno)); 385 cleanup_exit(1); 386 } else if ((r = sshbuf_put(iqueue, buf, len)) != 0) { 387 fatal("%s: buffer error: %s", 388 __func__, ssh_err(r)); 389 } 390 } 391 /* send oqueue to stdout */ 392 if ((pfd[1].revents & (POLLOUT|POLLHUP)) != 0) { 393 len = write(out, sshbuf_ptr(oqueue), 394 sshbuf_len(oqueue)); 395 if (len < 0) { 396 error("write: %s", strerror(errno)); 397 cleanup_exit(1); 398 } else if ((r = sshbuf_consume(oqueue, len)) != 0) { 399 fatal("%s: buffer error: %s", 400 __func__, ssh_err(r)); 401 } 402 } 403 404 /* 405 * Process requests from client if we can fit the results 406 * into the output buffer, otherwise stop processing input 407 * and let the output queue drain. 408 */ 409 if ((r = sshbuf_check_reserve(oqueue, MAX_MSG_LENGTH)) == 0) 410 process(); 411 else if (r != SSH_ERR_NO_BUFFER_SPACE) 412 fatal("%s: buffer error: %s", __func__, ssh_err(r)); 413 } 414 } 415