• Home
  • Line#
  • Scopes#
  • Navigate#
  • Raw
  • Download
1 /*
2  * Copyright 2014 The Android Open Source Project
3  *
4  * Licensed under the Apache License, Version 2.0 (the "License");
5  * you may not use this file except in compliance with the License.
6  * You may obtain a copy of the License at
7  *
8  *      http://www.apache.org/licenses/LICENSE-2.0
9  *
10  * Unless required by applicable law or agreed to in writing, software
11  * distributed under the License is distributed on an "AS IS" BASIS,
12  * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
13  * See the License for the specific language governing permissions and
14  * limitations under the License.
15  */
16 
17 #define LOG_TAG "TrustyKeymaster"
18 
19 #include <assert.h>
20 #include <errno.h>
21 #include <openssl/evp.h>
22 #include <openssl/x509.h>
23 #include <stddef.h>
24 #include <stdio.h>
25 #include <stdlib.h>
26 #include <string.h>
27 #include <time.h>
28 
29 #include <algorithm>
30 #include <type_traits>
31 
32 #include <hardware/keymaster2.h>
33 #include <keymaster/authorization_set.h>
34 #include <log/log.h>
35 
36 #include "keymaster_ipc.h"
37 #include "trusty_keymaster_device.h"
38 #include "trusty_keymaster_ipc.h"
39 
40 #define MY_PAGE_SIZE (PAGE_SIZE * 128)
41 const uint32_t RECV_BUF_SIZE = MY_PAGE_SIZE;
42 const uint32_t SEND_BUF_SIZE = (MY_PAGE_SIZE - sizeof(struct keymaster_message) - 16 /* tipc header */);
43 
44 const size_t kMaximumAttestationChallengeLength = 128;
45 const size_t kMaximumFinishInputLength = 2048 * 1024;
46 
47 namespace keymaster {
48 
translate_error(int err)49 static keymaster_error_t translate_error(int err) {
50     switch (err) {
51         case 0:
52             return KM_ERROR_OK;
53         case -EPERM:
54         case -EACCES:
55             return KM_ERROR_SECURE_HW_ACCESS_DENIED;
56 
57         case -ECANCELED:
58             return KM_ERROR_OPERATION_CANCELLED;
59 
60         case -ENODEV:
61             return KM_ERROR_UNIMPLEMENTED;
62 
63         case -ENOMEM:
64             return KM_ERROR_MEMORY_ALLOCATION_FAILED;
65 
66         case -EBUSY:
67             return KM_ERROR_SECURE_HW_BUSY;
68 
69         case -EIO:
70             return KM_ERROR_SECURE_HW_COMMUNICATION_FAILED;
71 
72         case -EOVERFLOW:
73             return KM_ERROR_INVALID_INPUT_LENGTH;
74 
75         default:
76             return KM_ERROR_UNKNOWN_ERROR;
77     }
78 }
79 
TrustyKeymasterDevice(const hw_module_t * module)80 TrustyKeymasterDevice::TrustyKeymasterDevice(const hw_module_t* module) {
81     static_assert(std::is_standard_layout<TrustyKeymasterDevice>::value,
82                   "TrustyKeymasterDevice must be standard layout");
83     static_assert(offsetof(TrustyKeymasterDevice, device_) == 0,
84                   "device_ must be the first member of TrustyKeymasterDevice");
85     static_assert(offsetof(TrustyKeymasterDevice, device_.common) == 0,
86                   "common must be the first member of keymaster2_device");
87 
88     ALOGI("Creating device");
89     ALOGD("Device address: %p", this);
90 
91     device_ = {};
92 
93     device_.common.tag = HARDWARE_DEVICE_TAG;
94     device_.common.version = 1;
95     device_.common.module = const_cast<hw_module_t*>(module);
96     device_.common.close = close_device;
97 
98     device_.flags = KEYMASTER_SUPPORTS_EC | KEYMASTER_BLOBS_ARE_STANDALONE ;
99 
100     device_.configure = configure;
101     device_.add_rng_entropy = add_rng_entropy;
102     device_.generate_key = generate_key;
103     device_.get_key_characteristics = get_key_characteristics;
104     device_.import_key = import_key;
105     device_.export_key = export_key;
106     device_.attest_key = attest_key;
107     device_.upgrade_key = upgrade_key;
108     device_.delete_key = nullptr;
109     device_.delete_all_keys = nullptr;
110     device_.begin = begin;
111     device_.update = update;
112     device_.finish = finish;
113     device_.abort = abort;
114 
115     GetVersionRequest version_request;
116     GetVersionResponse version_response;
117     error_ = Send(KM_GET_VERSION, version_request, &version_response);
118     if (error_ == KM_ERROR_INVALID_ARGUMENT || error_ == KM_ERROR_UNIMPLEMENTED) {
119         ALOGE("\"Bad parameters\" error on GetVersion call.  Version 0 is not supported.");
120         error_ = KM_ERROR_VERSION_MISMATCH;
121         return;
122     }
123     message_version_ = MessageVersion(version_response.major_ver, version_response.minor_ver,
124                                       version_response.subminor_ver);
125     if (message_version_ < 0) {
126         // Can't translate version?  Keymaster implementation must be newer.
127         ALOGE("Keymaster version %d.%d.%d not supported.", version_response.major_ver,
128               version_response.minor_ver, version_response.subminor_ver);
129         error_ = KM_ERROR_VERSION_MISMATCH;
130     }
131 }
132 
~TrustyKeymasterDevice()133 TrustyKeymasterDevice::~TrustyKeymasterDevice() {
134     trusty_keymaster_disconnect();
135 }
136 
137 namespace {
138 
139 // Allocates a new buffer with malloc and copies the contents of |buffer| to it. Caller takes
140 // ownership of the returned buffer.
DuplicateBuffer(const uint8_t * buffer,size_t size)141 uint8_t* DuplicateBuffer(const uint8_t* buffer, size_t size) {
142     uint8_t* tmp = reinterpret_cast<uint8_t*>(malloc(size));
143     if (tmp) {
144         memcpy(tmp, buffer, size);
145     }
146     return tmp;
147 }
148 
149 template <typename RequestType>
AddClientAndAppData(const keymaster_blob_t * client_id,const keymaster_blob_t * app_data,RequestType * request)150 void AddClientAndAppData(const keymaster_blob_t* client_id, const keymaster_blob_t* app_data,
151                          RequestType* request) {
152     request->additional_params.Clear();
153     if (client_id) {
154         request->additional_params.push_back(TAG_APPLICATION_ID, *client_id);
155     }
156     if (app_data) {
157         request->additional_params.push_back(TAG_APPLICATION_DATA, *app_data);
158     }
159 }
160 
161 }  //  unnamed namespace
162 
configure(const keymaster_key_param_set_t * params)163 keymaster_error_t TrustyKeymasterDevice::configure(const keymaster_key_param_set_t* params) {
164     ALOGD("Device received configure\n");
165 
166     if (error_ != KM_ERROR_OK) {
167         return error_;
168     }
169     if (!params) {
170         return KM_ERROR_UNEXPECTED_NULL_POINTER;
171     }
172 
173     AuthorizationSet params_copy(*params);
174     ConfigureRequest request;
175     if (!params_copy.GetTagValue(TAG_OS_VERSION, &request.os_version) ||
176         !params_copy.GetTagValue(TAG_OS_PATCHLEVEL, &request.os_patchlevel)) {
177         ALOGD("Configuration parameters must contain OS version and patch level");
178         return KM_ERROR_INVALID_ARGUMENT;
179     }
180 
181     ConfigureResponse response;
182     keymaster_error_t err = Send(KM_CONFIGURE, request, &response);
183     return err;
184 }
185 
add_rng_entropy(const uint8_t * data,size_t data_length)186 keymaster_error_t TrustyKeymasterDevice::add_rng_entropy(const uint8_t* data, size_t data_length) {
187     ALOGD("Device received add_rng_entropy");
188 
189     if (error_ != KM_ERROR_OK) {
190         return error_;
191     }
192 
193     AddEntropyRequest request;
194     request.random_data.Reinitialize(data, data_length);
195     AddEntropyResponse response;
196     return Send(KM_ADD_RNG_ENTROPY, request, &response);
197 }
198 
generate_key(const keymaster_key_param_set_t * params,keymaster_key_blob_t * key_blob,keymaster_key_characteristics_t * characteristics)199 keymaster_error_t TrustyKeymasterDevice::generate_key(
200     const keymaster_key_param_set_t* params, keymaster_key_blob_t* key_blob,
201     keymaster_key_characteristics_t* characteristics) {
202     ALOGD("Device received generate_key");
203 
204     if (error_ != KM_ERROR_OK) {
205         return error_;
206     }
207     if (!params) {
208         return KM_ERROR_UNEXPECTED_NULL_POINTER;
209     }
210     if (!key_blob) {
211         return KM_ERROR_OUTPUT_PARAMETER_NULL;
212     }
213 
214     GenerateKeyRequest request(message_version_);
215     request.key_description.Reinitialize(*params);
216     //request.key_description.push_back(TAG_CREATION_DATETIME, java_time(time(NULL)));
217 
218     GenerateKeyResponse response(message_version_);
219     keymaster_error_t err = Send(KM_GENERATE_KEY, request, &response);
220     if (err != KM_ERROR_OK) {
221         ALOGD("Device generate_key return error code %d", err);
222         return err;
223     }
224 
225     key_blob->key_material_size = response.key_blob.key_material_size;
226     key_blob->key_material =
227         DuplicateBuffer(response.key_blob.key_material, response.key_blob.key_material_size);
228     if (!key_blob->key_material) {
229         return KM_ERROR_MEMORY_ALLOCATION_FAILED;
230     }
231 
232     if (characteristics) {
233         response.enforced.CopyToParamSet(&characteristics->hw_enforced);
234         response.unenforced.CopyToParamSet(&characteristics->sw_enforced);
235     }
236 
237     return KM_ERROR_OK;
238 }
239 
get_key_characteristics(const keymaster_key_blob_t * key_blob,const keymaster_blob_t * client_id,const keymaster_blob_t * app_data,keymaster_key_characteristics_t * characteristics)240 keymaster_error_t TrustyKeymasterDevice::get_key_characteristics(
241     const keymaster_key_blob_t* key_blob, const keymaster_blob_t* client_id,
242     const keymaster_blob_t* app_data, keymaster_key_characteristics_t* characteristics) {
243     ALOGD("Device received get_key_characteristics");
244 
245     if (error_ != KM_ERROR_OK) {
246         return error_;
247     }
248     if (!key_blob || !key_blob->key_material) {
249         return KM_ERROR_UNEXPECTED_NULL_POINTER;
250     }
251     if (!characteristics) {
252         return KM_ERROR_OUTPUT_PARAMETER_NULL;
253     }
254 
255     GetKeyCharacteristicsRequest request;
256     request.SetKeyMaterial(*key_blob);
257     AddClientAndAppData(client_id, app_data, &request);
258 
259     GetKeyCharacteristicsResponse response;
260     keymaster_error_t err = Send(KM_GET_KEY_CHARACTERISTICS, request, &response);
261     if (err != KM_ERROR_OK) {
262         return err;
263     }
264 
265     response.enforced.CopyToParamSet(&characteristics->hw_enforced);
266     response.unenforced.CopyToParamSet(&characteristics->sw_enforced);
267 
268     return KM_ERROR_OK;
269 }
270 
import_key(const keymaster_key_param_set_t * params,keymaster_key_format_t key_format,const keymaster_blob_t * key_data,keymaster_key_blob_t * key_blob,keymaster_key_characteristics_t * characteristics)271 keymaster_error_t TrustyKeymasterDevice::import_key(
272     const keymaster_key_param_set_t* params, keymaster_key_format_t key_format,
273     const keymaster_blob_t* key_data, keymaster_key_blob_t* key_blob,
274     keymaster_key_characteristics_t* characteristics) {
275     ALOGD("Device received import_key");
276 
277     if (error_ != KM_ERROR_OK) {
278         return error_;
279     }
280     if (!params || !key_data) {
281         return KM_ERROR_UNEXPECTED_NULL_POINTER;
282     }
283     if (!key_blob) {
284         return KM_ERROR_OUTPUT_PARAMETER_NULL;
285     }
286 
287     ImportKeyRequest request(message_version_);
288     request.key_description.Reinitialize(*params);
289     //request.key_description.push_back(TAG_CREATION_DATETIME, java_time(time(NULL)));
290 
291     request.key_format = key_format;
292     request.SetKeyMaterial(key_data->data, key_data->data_length);
293 
294     ImportKeyResponse response(message_version_);
295     keymaster_error_t err = Send(KM_IMPORT_KEY, request, &response);
296     if (err != KM_ERROR_OK) {
297         return err;
298     }
299 
300     key_blob->key_material_size = response.key_blob.key_material_size;
301     key_blob->key_material =
302         DuplicateBuffer(response.key_blob.key_material, response.key_blob.key_material_size);
303     if (!key_blob->key_material) {
304         return KM_ERROR_MEMORY_ALLOCATION_FAILED;
305     }
306 
307     if (characteristics) {
308         response.enforced.CopyToParamSet(&characteristics->hw_enforced);
309         response.unenforced.CopyToParamSet(&characteristics->sw_enforced);
310     }
311 
312     return KM_ERROR_OK;
313 }
314 
export_key(keymaster_key_format_t export_format,const keymaster_key_blob_t * key_to_export,const keymaster_blob_t * client_id,const keymaster_blob_t * app_data,keymaster_blob_t * export_data)315 keymaster_error_t TrustyKeymasterDevice::export_key(keymaster_key_format_t export_format,
316                                                     const keymaster_key_blob_t* key_to_export,
317                                                     const keymaster_blob_t* client_id,
318                                                     const keymaster_blob_t* app_data,
319                                                     keymaster_blob_t* export_data) {
320     ALOGD("Device received export_key");
321 
322     if (error_ != KM_ERROR_OK) {
323         return error_;
324     }
325     if (!key_to_export || !key_to_export->key_material) {
326         return KM_ERROR_UNEXPECTED_NULL_POINTER;
327     }
328     if (!export_data) {
329         return KM_ERROR_OUTPUT_PARAMETER_NULL;
330     }
331 
332     export_data->data = nullptr;
333     export_data->data_length = 0;
334 
335     ExportKeyRequest request(message_version_);
336     request.key_format = export_format;
337     request.SetKeyMaterial(*key_to_export);
338     AddClientAndAppData(client_id, app_data, &request);
339 
340     ExportKeyResponse response(message_version_);
341     keymaster_error_t err = Send(KM_EXPORT_KEY, request, &response);
342     if (err != KM_ERROR_OK) {
343         return err;
344     }
345 
346     export_data->data_length = response.key_data_length;
347     export_data->data = DuplicateBuffer(response.key_data, response.key_data_length);
348     if (!export_data->data) {
349         return KM_ERROR_MEMORY_ALLOCATION_FAILED;
350     }
351 
352     return KM_ERROR_OK;
353 }
354 
attest_key(const keymaster_key_blob_t * key_to_attest,const keymaster_key_param_set_t * attest_params,keymaster_cert_chain_t * cert_chain)355 keymaster_error_t TrustyKeymasterDevice::attest_key(const keymaster_key_blob_t* key_to_attest,
356                                                     const keymaster_key_param_set_t* attest_params,
357                                                     keymaster_cert_chain_t* cert_chain) {
358     ALOGD("Device received attest_key");
359 
360     if (error_ != KM_ERROR_OK) {
361         return error_;
362     }
363     if (!key_to_attest || !attest_params) {
364         return KM_ERROR_UNEXPECTED_NULL_POINTER;
365     }
366     if (!cert_chain) {
367         return KM_ERROR_OUTPUT_PARAMETER_NULL;
368     }
369 
370     cert_chain->entry_count = 0;
371     cert_chain->entries = nullptr;
372 
373     AttestKeyRequest request;
374     request.SetKeyMaterial(*key_to_attest);
375     request.attest_params.Reinitialize(*attest_params);
376 
377     keymaster_blob_t attestation_challenge = {};
378     request.attest_params.GetTagValue(TAG_ATTESTATION_CHALLENGE, &attestation_challenge);
379     if (attestation_challenge.data_length > kMaximumAttestationChallengeLength) {
380         ALOGE("%zu-byte attestation challenge; only %zu bytes allowed",
381               attestation_challenge.data_length, kMaximumAttestationChallengeLength);
382         return KM_ERROR_INVALID_INPUT_LENGTH;
383     }
384 
385     AttestKeyResponse response;
386     keymaster_error_t err = Send(KM_ATTEST_KEY, request, &response);
387     if (err != KM_ERROR_OK) {
388         return err;
389     }
390 
391     // Allocate and clear storage for cert_chain.
392     keymaster_cert_chain_t& rsp_chain = response.certificate_chain;
393     cert_chain->entries = reinterpret_cast<keymaster_blob_t*>(
394         malloc(rsp_chain.entry_count * sizeof(*cert_chain->entries)));
395     if (!cert_chain->entries) {
396         return KM_ERROR_MEMORY_ALLOCATION_FAILED;
397     }
398     cert_chain->entry_count = rsp_chain.entry_count;
399     for (keymaster_blob_t& entry : array_range(cert_chain->entries, cert_chain->entry_count)) {
400         entry = {};
401     }
402 
403     // Copy cert_chain contents
404     size_t i = 0;
405     for (keymaster_blob_t& entry : array_range(rsp_chain.entries, rsp_chain.entry_count)) {
406         cert_chain->entries[i].data = DuplicateBuffer(entry.data, entry.data_length);
407         if (!cert_chain->entries[i].data) {
408             keymaster_free_cert_chain(cert_chain);
409             return KM_ERROR_MEMORY_ALLOCATION_FAILED;
410         }
411         cert_chain->entries[i].data_length = entry.data_length;
412         ++i;
413     }
414 
415     return KM_ERROR_OK;
416 }
417 
upgrade_key(const keymaster_key_blob_t * key_to_upgrade,const keymaster_key_param_set_t * upgrade_params,keymaster_key_blob_t * upgraded_key)418 keymaster_error_t TrustyKeymasterDevice::upgrade_key(const keymaster_key_blob_t* key_to_upgrade,
419                                                      const keymaster_key_param_set_t* upgrade_params,
420                                                      keymaster_key_blob_t* upgraded_key) {
421     ALOGD("Device received upgrade_key");
422 
423     if (error_ != KM_ERROR_OK) {
424         return error_;
425     }
426     if (!key_to_upgrade || !upgrade_params) {
427         return KM_ERROR_UNEXPECTED_NULL_POINTER;
428     }
429     if (!upgraded_key) {
430         return KM_ERROR_OUTPUT_PARAMETER_NULL;
431     }
432 
433     UpgradeKeyRequest request;
434     request.SetKeyMaterial(*key_to_upgrade);
435     request.upgrade_params.Reinitialize(*upgrade_params);
436 
437     UpgradeKeyResponse response;
438     keymaster_error_t err = Send(KM_UPGRADE_KEY, request, &response);
439     if (err != KM_ERROR_OK) {
440         return err;
441     }
442 
443     upgraded_key->key_material_size = response.upgraded_key.key_material_size;
444     upgraded_key->key_material = DuplicateBuffer(response.upgraded_key.key_material,
445                                                  response.upgraded_key.key_material_size);
446     if (!upgraded_key->key_material) {
447         return KM_ERROR_MEMORY_ALLOCATION_FAILED;
448     }
449 
450     return KM_ERROR_OK;
451 }
452 
begin(keymaster_purpose_t purpose,const keymaster_key_blob_t * key,const keymaster_key_param_set_t * in_params,keymaster_key_param_set_t * out_params,keymaster_operation_handle_t * operation_handle)453 keymaster_error_t TrustyKeymasterDevice::begin(keymaster_purpose_t purpose,
454                                                const keymaster_key_blob_t* key,
455                                                const keymaster_key_param_set_t* in_params,
456                                                keymaster_key_param_set_t* out_params,
457                                                keymaster_operation_handle_t* operation_handle) {
458     ALOGD("Device received begin");
459 
460     if (error_ != KM_ERROR_OK) {
461         return error_;
462     }
463     if (!key || !key->key_material) {
464         return KM_ERROR_UNEXPECTED_NULL_POINTER;
465     }
466     if (!operation_handle) {
467         return KM_ERROR_OUTPUT_PARAMETER_NULL;
468     }
469 
470     if (out_params) {
471         *out_params = {};
472     }
473 
474     BeginOperationRequest request;
475     request.purpose = purpose;
476     request.SetKeyMaterial(*key);
477     request.additional_params.Reinitialize(*in_params);
478 
479     BeginOperationResponse response;
480     keymaster_error_t err = Send(KM_BEGIN_OPERATION, request, &response);
481     if (err != KM_ERROR_OK) {
482         return err;
483     }
484 
485     if (response.output_params.size() > 0) {
486         if (out_params) {
487             response.output_params.CopyToParamSet(out_params);
488         } else {
489             return KM_ERROR_OUTPUT_PARAMETER_NULL;
490         }
491     }
492     *operation_handle = response.op_handle;
493 
494     return KM_ERROR_OK;
495 }
496 
update(keymaster_operation_handle_t operation_handle,const keymaster_key_param_set_t * in_params,const keymaster_blob_t * input,size_t * input_consumed,keymaster_key_param_set_t * out_params,keymaster_blob_t * output)497 keymaster_error_t TrustyKeymasterDevice::update(keymaster_operation_handle_t operation_handle,
498                                                 const keymaster_key_param_set_t* in_params,
499                                                 const keymaster_blob_t* input,
500                                                 size_t* input_consumed,
501                                                 keymaster_key_param_set_t* out_params,
502                                                 keymaster_blob_t* output) {
503     ALOGD("Device received update");
504 
505     if (error_ != KM_ERROR_OK) {
506         return error_;
507     }
508     if (!input) {
509         return KM_ERROR_UNEXPECTED_NULL_POINTER;
510     }
511     if (!input_consumed) {
512         return KM_ERROR_OUTPUT_PARAMETER_NULL;
513     }
514 
515     if (out_params) {
516         *out_params = {};
517     }
518     if (output) {
519         *output = {};
520     }
521 
522     UpdateOperationRequest request;
523     request.op_handle = operation_handle;
524     if (in_params) {
525         request.additional_params.Reinitialize(*in_params);
526     }
527     if (input && input->data_length > 0) {
528         size_t max_input_size = SEND_BUF_SIZE - request.SerializedSize();
529         request.input.Reinitialize(input->data, std::min(input->data_length, max_input_size));
530     }
531 
532     UpdateOperationResponse response;
533     keymaster_error_t err = Send(KM_UPDATE_OPERATION, request, &response);
534     if (err != KM_ERROR_OK) {
535         return err;
536     }
537 
538     if (response.output_params.size() > 0) {
539         if (out_params) {
540             response.output_params.CopyToParamSet(out_params);
541         } else {
542             return KM_ERROR_OUTPUT_PARAMETER_NULL;
543         }
544     }
545     *input_consumed = response.input_consumed;
546     if (output) {
547         output->data_length = response.output.available_read();
548         output->data = DuplicateBuffer(response.output.peek_read(), output->data_length);
549         if (!output->data) {
550             return KM_ERROR_MEMORY_ALLOCATION_FAILED;
551         }
552     } else if (response.output.available_read() > 0) {
553         return KM_ERROR_OUTPUT_PARAMETER_NULL;
554     }
555 
556     return KM_ERROR_OK;
557 }
558 
finish(keymaster_operation_handle_t operation_handle,const keymaster_key_param_set_t * in_params,const keymaster_blob_t * input,const keymaster_blob_t * signature,keymaster_key_param_set_t * out_params,keymaster_blob_t * output)559 keymaster_error_t TrustyKeymasterDevice::finish(keymaster_operation_handle_t operation_handle,
560                                                 const keymaster_key_param_set_t* in_params,
561                                                 const keymaster_blob_t* input,
562                                                 const keymaster_blob_t* signature,
563                                                 keymaster_key_param_set_t* out_params,
564                                                 keymaster_blob_t* output) {
565     ALOGE("Device received finish");
566 
567     if (error_ != KM_ERROR_OK) {
568         return error_;
569     }
570     if (input && input->data_length > kMaximumFinishInputLength) {
571     ALOGE("here %s at %d", __func__, __LINE__);
572         return KM_ERROR_INVALID_ARGUMENT;
573     }
574 
575     if (out_params) {
576         *out_params = {};
577     }
578     if (output) {
579         *output = {};
580     }
581 
582     FinishOperationRequest request;
583     request.op_handle = operation_handle;
584     if (signature && signature->data && signature->data_length > 0) {
585         request.signature.Reinitialize(signature->data, signature->data_length);
586         ALOGE("here %s at %d signature length %d", __func__, __LINE__,
587                 (int)(signature->data_length));
588     }
589     if (input && input->data && input->data_length) {
590         request.input.Reinitialize(input->data, input->data_length);
591         ALOGE("here %s at %d input data length %d", __func__, __LINE__,
592                 (int)(input->data_length));
593     }
594     if (in_params) {
595         request.additional_params.Reinitialize(*in_params);
596     }
597 
598     FinishOperationResponse response;
599     keymaster_error_t err = Send(KM_FINISH_OPERATION, request, &response);
600     if (err != KM_ERROR_OK) {
601     ALOGE("here %s at %d", __func__, __LINE__);
602         return err;
603     }
604 
605     if (response.output_params.size() > 0) {
606         if (out_params) {
607             response.output_params.CopyToParamSet(out_params);
608         } else {
609     ALOGE("here %s at %d", __func__, __LINE__);
610             return KM_ERROR_OUTPUT_PARAMETER_NULL;
611         }
612     }
613     if (output) {
614         output->data_length = response.output.available_read();
615         output->data = DuplicateBuffer(response.output.peek_read(), output->data_length);
616         if (!output->data) {
617             ALOGE("here %s at %d", __func__, __LINE__);
618             return KM_ERROR_MEMORY_ALLOCATION_FAILED;
619         } else {
620             ALOGE("here %s at %d output data length %d", __func__, __LINE__,
621                     (int)(output->data_length));
622         }
623     } else if (response.output.available_read() > 0) {
624         ALOGE("here %s at %d", __func__, __LINE__);
625         return KM_ERROR_OUTPUT_PARAMETER_NULL;
626     }
627 
628     ALOGE("OK here %s at %d", __func__, __LINE__);
629     return KM_ERROR_OK;
630 }
631 
abort(keymaster_operation_handle_t operation_handle)632 keymaster_error_t TrustyKeymasterDevice::abort(keymaster_operation_handle_t operation_handle) {
633     ALOGD("Device received abort");
634 
635     if (error_ != KM_ERROR_OK) {
636         return error_;
637     }
638 
639     AbortOperationRequest request;
640     request.op_handle = operation_handle;
641     AbortOperationResponse response;
642     return Send(KM_ABORT_OPERATION, request, &response);
643 }
644 
hw_device()645 hw_device_t* TrustyKeymasterDevice::hw_device() {
646     return &device_.common;
647 }
648 
convert_device(const keymaster2_device_t * dev)649 static inline TrustyKeymasterDevice* convert_device(const keymaster2_device_t* dev) {
650     return reinterpret_cast<TrustyKeymasterDevice*>(const_cast<keymaster2_device_t*>(dev));
651 }
652 
653 /* static */
close_device(hw_device_t * dev)654 int TrustyKeymasterDevice::close_device(hw_device_t* dev) {
655     delete reinterpret_cast<TrustyKeymasterDevice*>(dev);
656     return 0;
657 }
658 
659 /* static */
configure(const keymaster2_device_t * dev,const keymaster_key_param_set_t * params)660 keymaster_error_t TrustyKeymasterDevice::configure(const keymaster2_device_t* dev,
661                                                    const keymaster_key_param_set_t* params) {
662     return convert_device(dev)->configure(params);
663 }
664 
665 /* static */
add_rng_entropy(const keymaster2_device_t * dev,const uint8_t * data,size_t data_length)666 keymaster_error_t TrustyKeymasterDevice::add_rng_entropy(const keymaster2_device_t* dev,
667                                                          const uint8_t* data, size_t data_length) {
668     return convert_device(dev)->add_rng_entropy(data, data_length);
669 }
670 
671 /* static */
generate_key(const keymaster2_device_t * dev,const keymaster_key_param_set_t * params,keymaster_key_blob_t * key_blob,keymaster_key_characteristics_t * characteristics)672 keymaster_error_t TrustyKeymasterDevice::generate_key(
673     const keymaster2_device_t* dev, const keymaster_key_param_set_t* params,
674     keymaster_key_blob_t* key_blob, keymaster_key_characteristics_t* characteristics) {
675     return convert_device(dev)->generate_key(params, key_blob, characteristics);
676 }
677 
678 /* static */
get_key_characteristics(const keymaster2_device_t * dev,const keymaster_key_blob_t * key_blob,const keymaster_blob_t * client_id,const keymaster_blob_t * app_data,keymaster_key_characteristics_t * characteristics)679 keymaster_error_t TrustyKeymasterDevice::get_key_characteristics(
680     const keymaster2_device_t* dev, const keymaster_key_blob_t* key_blob,
681     const keymaster_blob_t* client_id, const keymaster_blob_t* app_data,
682     keymaster_key_characteristics_t* characteristics) {
683     return convert_device(dev)->get_key_characteristics(key_blob, client_id, app_data,
684                                                         characteristics);
685 }
686 
687 /* static */
import_key(const keymaster2_device_t * dev,const keymaster_key_param_set_t * params,keymaster_key_format_t key_format,const keymaster_blob_t * key_data,keymaster_key_blob_t * key_blob,keymaster_key_characteristics_t * characteristics)688 keymaster_error_t TrustyKeymasterDevice::import_key(
689     const keymaster2_device_t* dev, const keymaster_key_param_set_t* params,
690     keymaster_key_format_t key_format, const keymaster_blob_t* key_data,
691     keymaster_key_blob_t* key_blob, keymaster_key_characteristics_t* characteristics) {
692     return convert_device(dev)->import_key(params, key_format, key_data, key_blob, characteristics);
693 }
694 
695 /* static */
export_key(const keymaster2_device_t * dev,keymaster_key_format_t export_format,const keymaster_key_blob_t * key_to_export,const keymaster_blob_t * client_id,const keymaster_blob_t * app_data,keymaster_blob_t * export_data)696 keymaster_error_t TrustyKeymasterDevice::export_key(const keymaster2_device_t* dev,
697                                                     keymaster_key_format_t export_format,
698                                                     const keymaster_key_blob_t* key_to_export,
699                                                     const keymaster_blob_t* client_id,
700                                                     const keymaster_blob_t* app_data,
701                                                     keymaster_blob_t* export_data) {
702     return convert_device(dev)->export_key(export_format, key_to_export, client_id, app_data,
703                                            export_data);
704 }
705 
706 /* static */
attest_key(const keymaster2_device_t * dev,const keymaster_key_blob_t * key_to_attest,const keymaster_key_param_set_t * attest_params,keymaster_cert_chain_t * cert_chain)707 keymaster_error_t TrustyKeymasterDevice::attest_key(const keymaster2_device_t* dev,
708                                                     const keymaster_key_blob_t* key_to_attest,
709                                                     const keymaster_key_param_set_t* attest_params,
710                                                     keymaster_cert_chain_t* cert_chain) {
711     return convert_device(dev)->attest_key(key_to_attest, attest_params, cert_chain);
712 }
713 
714 /* static */
upgrade_key(const keymaster2_device_t * dev,const keymaster_key_blob_t * key_to_upgrade,const keymaster_key_param_set_t * upgrade_params,keymaster_key_blob_t * upgraded_key)715 keymaster_error_t TrustyKeymasterDevice::upgrade_key(const keymaster2_device_t* dev,
716                                                      const keymaster_key_blob_t* key_to_upgrade,
717                                                      const keymaster_key_param_set_t* upgrade_params,
718                                                      keymaster_key_blob_t* upgraded_key) {
719     return convert_device(dev)->upgrade_key(key_to_upgrade, upgrade_params, upgraded_key);
720 }
721 
722 /* static */
begin(const keymaster2_device_t * dev,keymaster_purpose_t purpose,const keymaster_key_blob_t * key,const keymaster_key_param_set_t * in_params,keymaster_key_param_set_t * out_params,keymaster_operation_handle_t * operation_handle)723 keymaster_error_t TrustyKeymasterDevice::begin(const keymaster2_device_t* dev,
724                                                keymaster_purpose_t purpose,
725                                                const keymaster_key_blob_t* key,
726                                                const keymaster_key_param_set_t* in_params,
727                                                keymaster_key_param_set_t* out_params,
728                                                keymaster_operation_handle_t* operation_handle) {
729     return convert_device(dev)->begin(purpose, key, in_params, out_params, operation_handle);
730 }
731 
732 /* static */
update(const keymaster2_device_t * dev,keymaster_operation_handle_t operation_handle,const keymaster_key_param_set_t * in_params,const keymaster_blob_t * input,size_t * input_consumed,keymaster_key_param_set_t * out_params,keymaster_blob_t * output)733 keymaster_error_t TrustyKeymasterDevice::update(
734     const keymaster2_device_t* dev, keymaster_operation_handle_t operation_handle,
735     const keymaster_key_param_set_t* in_params, const keymaster_blob_t* input,
736     size_t* input_consumed, keymaster_key_param_set_t* out_params, keymaster_blob_t* output) {
737     return convert_device(dev)->update(operation_handle, in_params, input, input_consumed,
738                                        out_params, output);
739 }
740 
741 /* static */
finish(const keymaster2_device_t * dev,keymaster_operation_handle_t operation_handle,const keymaster_key_param_set_t * in_params,const keymaster_blob_t * input,const keymaster_blob_t * signature,keymaster_key_param_set_t * out_params,keymaster_blob_t * output)742 keymaster_error_t TrustyKeymasterDevice::finish(const keymaster2_device_t* dev,
743                                                 keymaster_operation_handle_t operation_handle,
744                                                 const keymaster_key_param_set_t* in_params,
745                                                 const keymaster_blob_t* input,
746                                                 const keymaster_blob_t* signature,
747                                                 keymaster_key_param_set_t* out_params,
748                                                 keymaster_blob_t* output) {
749     return convert_device(dev)->finish(operation_handle, in_params, input, signature, out_params,
750                                        output);
751 }
752 
753 /* static */
abort(const keymaster2_device_t * dev,keymaster_operation_handle_t operation_handle)754 keymaster_error_t TrustyKeymasterDevice::abort(const keymaster2_device_t* dev,
755                                                keymaster_operation_handle_t operation_handle) {
756     return convert_device(dev)->abort(operation_handle);
757 }
758 
Send(uint32_t command,const Serializable & req,KeymasterResponse * rsp)759 keymaster_error_t TrustyKeymasterDevice::Send(uint32_t command, const Serializable& req,
760                                               KeymasterResponse* rsp) {
761     uint32_t req_size = req.SerializedSize();
762     if (req_size > SEND_BUF_SIZE) {
763         return KM_ERROR_MEMORY_ALLOCATION_FAILED;
764     }
765     uint8_t send_buf[SEND_BUF_SIZE];
766     Eraser send_buf_eraser(send_buf, SEND_BUF_SIZE);
767     req.Serialize(send_buf, send_buf + req_size);
768 
769     // Send it
770     uint8_t recv_buf[RECV_BUF_SIZE];
771     Eraser recv_buf_eraser(recv_buf, RECV_BUF_SIZE);
772     uint32_t rsp_size = RECV_BUF_SIZE;
773     // ALOGE("Sending %d byte request\n", (int)req.SerializedSize());
774     int rc = trusty_keymaster_call(command, send_buf, req_size, recv_buf, &rsp_size);
775     if (rc < 0) {
776         ALOGE("tipc error: %d\n", rc);
777         return translate_error(rc);
778     } else {
779         ALOGE("Received %d byte response\n", (int)rsp_size);
780     }
781 
782     const uint8_t* p = recv_buf;
783     if (!rsp->Deserialize(&p, p + rsp_size)) {
784         ALOGE("Error deserializing response of size %d\n", (int)rsp_size);
785         return KM_ERROR_UNKNOWN_ERROR;
786     } else if (rsp->error != KM_ERROR_OK) {
787         ALOGE("Error: Response of size %d contained error code %d\n", (int)rsp_size, (int)rsp->error);
788         return rsp->error;
789     }
790     return rsp->error;
791 }
792 
793 }  // namespace keymaster
794