Device interface library for multiple platforms including Mbed.
Dependents: DeepCover Embedded Security in IoT MaximInterface MAXREFDES155#
Maxim Interface is a library framework focused on providing flexible and expressive hardware interfaces. Both communication interfaces such as I2C and 1-Wire and device interfaces such as DS18B20 are supported. Modern C++ concepts are used extensively while keeping compatibility with C++98/C++03 and requiring no external dependencies. The embedded-friendly design does not depend on exceptions or RTTI.
The full version of the project is hosted on GitLab: https://gitlab.com/iabenz/MaximInterface
MaximInterfaceDevices/DS28C39.cpp@7:9cd16581b578, 2019-07-22 (annotated)
- Committer:
- IanBenzMaxim
- Date:
- Mon Jul 22 11:44:07 2019 -0500
- Revision:
- 7:9cd16581b578
- Child:
- 8:5ea891c7d1a1
Updated to version 1.9.
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
IanBenzMaxim | 7:9cd16581b578 | 1 | /******************************************************************************* |
IanBenzMaxim | 7:9cd16581b578 | 2 | * Copyright (C) 2018 Maxim Integrated Products, Inc., All Rights Reserved. |
IanBenzMaxim | 7:9cd16581b578 | 3 | * |
IanBenzMaxim | 7:9cd16581b578 | 4 | * Permission is hereby granted, free of charge, to any person obtaining a |
IanBenzMaxim | 7:9cd16581b578 | 5 | * copy of this software and associated documentation files (the "Software"), |
IanBenzMaxim | 7:9cd16581b578 | 6 | * to deal in the Software without restriction, including without limitation |
IanBenzMaxim | 7:9cd16581b578 | 7 | * the rights to use, copy, modify, merge, publish, distribute, sublicense, |
IanBenzMaxim | 7:9cd16581b578 | 8 | * and/or sell copies of the Software, and to permit persons to whom the |
IanBenzMaxim | 7:9cd16581b578 | 9 | * Software is furnished to do so, subject to the following conditions: |
IanBenzMaxim | 7:9cd16581b578 | 10 | * |
IanBenzMaxim | 7:9cd16581b578 | 11 | * The above copyright notice and this permission notice shall be included |
IanBenzMaxim | 7:9cd16581b578 | 12 | * in all copies or substantial portions of the Software. |
IanBenzMaxim | 7:9cd16581b578 | 13 | * |
IanBenzMaxim | 7:9cd16581b578 | 14 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS |
IanBenzMaxim | 7:9cd16581b578 | 15 | * OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF |
IanBenzMaxim | 7:9cd16581b578 | 16 | * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. |
IanBenzMaxim | 7:9cd16581b578 | 17 | * IN NO EVENT SHALL MAXIM INTEGRATED BE LIABLE FOR ANY CLAIM, DAMAGES |
IanBenzMaxim | 7:9cd16581b578 | 18 | * OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, |
IanBenzMaxim | 7:9cd16581b578 | 19 | * ARISING FROM, OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR |
IanBenzMaxim | 7:9cd16581b578 | 20 | * OTHER DEALINGS IN THE SOFTWARE. |
IanBenzMaxim | 7:9cd16581b578 | 21 | * |
IanBenzMaxim | 7:9cd16581b578 | 22 | * Except as contained in this notice, the name of Maxim Integrated |
IanBenzMaxim | 7:9cd16581b578 | 23 | * Products, Inc. shall not be used except as stated in the Maxim Integrated |
IanBenzMaxim | 7:9cd16581b578 | 24 | * Products, Inc. Branding Policy. |
IanBenzMaxim | 7:9cd16581b578 | 25 | * |
IanBenzMaxim | 7:9cd16581b578 | 26 | * The mere transfer of this software does not imply any licenses |
IanBenzMaxim | 7:9cd16581b578 | 27 | * of trade secrets, proprietary technology, copyrights, patents, |
IanBenzMaxim | 7:9cd16581b578 | 28 | * trademarks, maskwork rights, or any other form of intellectual |
IanBenzMaxim | 7:9cd16581b578 | 29 | * property whatsoever. Maxim Integrated Products, Inc. retains all |
IanBenzMaxim | 7:9cd16581b578 | 30 | * ownership rights. |
IanBenzMaxim | 7:9cd16581b578 | 31 | *******************************************************************************/ |
IanBenzMaxim | 7:9cd16581b578 | 32 | |
IanBenzMaxim | 7:9cd16581b578 | 33 | #include <stddef.h> |
IanBenzMaxim | 7:9cd16581b578 | 34 | #include <algorithm> |
IanBenzMaxim | 7:9cd16581b578 | 35 | #include <MaximInterfaceCore/Error.hpp> |
IanBenzMaxim | 7:9cd16581b578 | 36 | #include "DS28C39.hpp" |
IanBenzMaxim | 7:9cd16581b578 | 37 | |
IanBenzMaxim | 7:9cd16581b578 | 38 | namespace MaximInterfaceDevices { |
IanBenzMaxim | 7:9cd16581b578 | 39 | |
IanBenzMaxim | 7:9cd16581b578 | 40 | using namespace Core; |
IanBenzMaxim | 7:9cd16581b578 | 41 | using std::copy; |
IanBenzMaxim | 7:9cd16581b578 | 42 | |
IanBenzMaxim | 7:9cd16581b578 | 43 | static const int readMemoryTimeMs = 30; |
IanBenzMaxim | 7:9cd16581b578 | 44 | static const int writeMemoryTimeMs = 65; |
IanBenzMaxim | 7:9cd16581b578 | 45 | static const int writeStateTimeMs = 15; |
IanBenzMaxim | 7:9cd16581b578 | 46 | static const int generateEccKeyPairTimeMs = 200; |
IanBenzMaxim | 7:9cd16581b578 | 47 | static const int generateEcdsaSignatureTimeMs = 130; |
IanBenzMaxim | 7:9cd16581b578 | 48 | static const int trngOnDemandCheckTimeMs = 20; |
IanBenzMaxim | 7:9cd16581b578 | 49 | static const int trngGenerationTimeMs = 10; |
IanBenzMaxim | 7:9cd16581b578 | 50 | static const int verifyEcdsaSignatureTimeMs = 180; |
IanBenzMaxim | 7:9cd16581b578 | 51 | |
IanBenzMaxim | 7:9cd16581b578 | 52 | const int DS28C39::authorityPublicKeyXPage; |
IanBenzMaxim | 7:9cd16581b578 | 53 | const int DS28C39::authorityPublicKeyYPage; |
IanBenzMaxim | 7:9cd16581b578 | 54 | const int DS28C39::writePublicKeyXPage; |
IanBenzMaxim | 7:9cd16581b578 | 55 | const int DS28C39::writePublicKeyYPage; |
IanBenzMaxim | 7:9cd16581b578 | 56 | const int DS28C39::memoryPages; |
IanBenzMaxim | 7:9cd16581b578 | 57 | |
IanBenzMaxim | 7:9cd16581b578 | 58 | error_code DS28C39::writeMemory(int pageNum, Page::const_span page) { |
IanBenzMaxim | 7:9cd16581b578 | 59 | if (pageNum < 0 || pageNum >= memoryPages) { |
IanBenzMaxim | 7:9cd16581b578 | 60 | return make_error_code(InvalidParameterError); |
IanBenzMaxim | 7:9cd16581b578 | 61 | } |
IanBenzMaxim | 7:9cd16581b578 | 62 | |
IanBenzMaxim | 7:9cd16581b578 | 63 | uint_least8_t request[2 + Page::size]; |
IanBenzMaxim | 7:9cd16581b578 | 64 | request[0] = 0x96; |
IanBenzMaxim | 7:9cd16581b578 | 65 | request[1] = pageNum; |
IanBenzMaxim | 7:9cd16581b578 | 66 | copy(page.begin(), page.end(), request + 2); |
IanBenzMaxim | 7:9cd16581b578 | 67 | return runCommand(request, writeMemoryTimeMs); |
IanBenzMaxim | 7:9cd16581b578 | 68 | } |
IanBenzMaxim | 7:9cd16581b578 | 69 | |
IanBenzMaxim | 7:9cd16581b578 | 70 | error_code DS28C39::readMemory(int pageNum, Page::span page) { |
IanBenzMaxim | 7:9cd16581b578 | 71 | if (pageNum < 0 || pageNum >= memoryPages) { |
IanBenzMaxim | 7:9cd16581b578 | 72 | return make_error_code(InvalidParameterError); |
IanBenzMaxim | 7:9cd16581b578 | 73 | } |
IanBenzMaxim | 7:9cd16581b578 | 74 | |
IanBenzMaxim | 7:9cd16581b578 | 75 | uint_least8_t buffer[1 + Page::size]; |
IanBenzMaxim | 7:9cd16581b578 | 76 | buffer[0] = 0x44; |
IanBenzMaxim | 7:9cd16581b578 | 77 | buffer[1] = pageNum; |
IanBenzMaxim | 7:9cd16581b578 | 78 | span<uint_least8_t> response(buffer); |
IanBenzMaxim | 7:9cd16581b578 | 79 | const error_code result = |
IanBenzMaxim | 7:9cd16581b578 | 80 | runCommand(make_span(buffer, 2), readMemoryTimeMs, response); |
IanBenzMaxim | 7:9cd16581b578 | 81 | if (!result) { |
IanBenzMaxim | 7:9cd16581b578 | 82 | copy(response.begin(), response.end(), page.begin()); |
IanBenzMaxim | 7:9cd16581b578 | 83 | } |
IanBenzMaxim | 7:9cd16581b578 | 84 | return result; |
IanBenzMaxim | 7:9cd16581b578 | 85 | } |
IanBenzMaxim | 7:9cd16581b578 | 86 | |
IanBenzMaxim | 7:9cd16581b578 | 87 | error_code DS28C39::readStatus(bool entropyHealthTest, Status & status) { |
IanBenzMaxim | 7:9cd16581b578 | 88 | int delay = readMemoryTimeMs; |
IanBenzMaxim | 7:9cd16581b578 | 89 | if (entropyHealthTest) { |
IanBenzMaxim | 7:9cd16581b578 | 90 | delay += trngOnDemandCheckTimeMs; |
IanBenzMaxim | 7:9cd16581b578 | 91 | } |
IanBenzMaxim | 7:9cd16581b578 | 92 | uint_least8_t buffer[Status::PageProtectionList::csize + RomId::size + |
IanBenzMaxim | 7:9cd16581b578 | 93 | ManId::size + Status::RomVersion::csize + 2]; |
IanBenzMaxim | 7:9cd16581b578 | 94 | buffer[0] = 0xAA; |
IanBenzMaxim | 7:9cd16581b578 | 95 | buffer[1] = entropyHealthTest ? 0x01 : 0x00; |
IanBenzMaxim | 7:9cd16581b578 | 96 | span<uint_least8_t> response(buffer); |
IanBenzMaxim | 7:9cd16581b578 | 97 | error_code result = runCommand(make_span(buffer, 2), delay, response); |
IanBenzMaxim | 7:9cd16581b578 | 98 | if (!result) { |
IanBenzMaxim | 7:9cd16581b578 | 99 | span<uint_least8_t>::const_iterator responseIt = response.begin(); |
IanBenzMaxim | 7:9cd16581b578 | 100 | for (Status::PageProtectionList::iterator it = |
IanBenzMaxim | 7:9cd16581b578 | 101 | status.pageProtection.begin(); |
IanBenzMaxim | 7:9cd16581b578 | 102 | it != status.pageProtection.end(); ++it) { |
IanBenzMaxim | 7:9cd16581b578 | 103 | *it = *responseIt; |
IanBenzMaxim | 7:9cd16581b578 | 104 | ++responseIt; |
IanBenzMaxim | 7:9cd16581b578 | 105 | } |
IanBenzMaxim | 7:9cd16581b578 | 106 | span<uint_least8_t>::const_iterator responseItEnd = |
IanBenzMaxim | 7:9cd16581b578 | 107 | responseIt + status.romId.size(); |
IanBenzMaxim | 7:9cd16581b578 | 108 | copy(responseIt, responseItEnd, status.romId.begin()); |
IanBenzMaxim | 7:9cd16581b578 | 109 | responseIt = responseItEnd; |
IanBenzMaxim | 7:9cd16581b578 | 110 | responseItEnd = responseIt + status.manId.size(); |
IanBenzMaxim | 7:9cd16581b578 | 111 | copy(responseIt, responseItEnd, status.manId.begin()); |
IanBenzMaxim | 7:9cd16581b578 | 112 | responseIt = responseItEnd; |
IanBenzMaxim | 7:9cd16581b578 | 113 | responseItEnd = responseIt + status.romVersion.size(); |
IanBenzMaxim | 7:9cd16581b578 | 114 | copy(responseIt, responseItEnd, status.romVersion.begin()); |
IanBenzMaxim | 7:9cd16581b578 | 115 | responseIt = responseItEnd; |
IanBenzMaxim | 7:9cd16581b578 | 116 | switch (*responseIt) { |
IanBenzMaxim | 7:9cd16581b578 | 117 | case Status::TestNotPerformed: |
IanBenzMaxim | 7:9cd16581b578 | 118 | case Status::EntropyHealthy: |
IanBenzMaxim | 7:9cd16581b578 | 119 | case Status::EntropyNotHealthy: |
IanBenzMaxim | 7:9cd16581b578 | 120 | status.entropyHealthTestStatus = |
IanBenzMaxim | 7:9cd16581b578 | 121 | static_cast<Status::EntropyHealthTestStatus>(*responseIt); |
IanBenzMaxim | 7:9cd16581b578 | 122 | break; |
IanBenzMaxim | 7:9cd16581b578 | 123 | |
IanBenzMaxim | 7:9cd16581b578 | 124 | default: |
IanBenzMaxim | 7:9cd16581b578 | 125 | result = make_error_code(InvalidResponseError); |
IanBenzMaxim | 7:9cd16581b578 | 126 | break; |
IanBenzMaxim | 7:9cd16581b578 | 127 | } |
IanBenzMaxim | 7:9cd16581b578 | 128 | } |
IanBenzMaxim | 7:9cd16581b578 | 129 | return result; |
IanBenzMaxim | 7:9cd16581b578 | 130 | } |
IanBenzMaxim | 7:9cd16581b578 | 131 | |
IanBenzMaxim | 7:9cd16581b578 | 132 | error_code DS28C39::setPageProtection(int pageNum, |
IanBenzMaxim | 7:9cd16581b578 | 133 | const PageProtection & protection) { |
IanBenzMaxim | 7:9cd16581b578 | 134 | if (pageNum < 0 || pageNum >= memoryPages) { |
IanBenzMaxim | 7:9cd16581b578 | 135 | return make_error_code(InvalidParameterError); |
IanBenzMaxim | 7:9cd16581b578 | 136 | } |
IanBenzMaxim | 7:9cd16581b578 | 137 | |
IanBenzMaxim | 7:9cd16581b578 | 138 | const uint_least8_t request[] = { |
IanBenzMaxim | 7:9cd16581b578 | 139 | 0xC3, static_cast<uint_least8_t>(pageNum), |
IanBenzMaxim | 7:9cd16581b578 | 140 | static_cast<uint_least8_t>(protection.to_ulong())}; |
IanBenzMaxim | 7:9cd16581b578 | 141 | return runCommand(request, writeStateTimeMs); |
IanBenzMaxim | 7:9cd16581b578 | 142 | } |
IanBenzMaxim | 7:9cd16581b578 | 143 | |
IanBenzMaxim | 7:9cd16581b578 | 144 | error_code |
IanBenzMaxim | 7:9cd16581b578 | 145 | DS28C39::computeAndReadPageAuthentication(int pageNum, bool anonymous, |
IanBenzMaxim | 7:9cd16581b578 | 146 | Page::const_span challenge, |
IanBenzMaxim | 7:9cd16581b578 | 147 | Ecc256::Signature::span signature) { |
IanBenzMaxim | 7:9cd16581b578 | 148 | if (pageNum < 0 || pageNum >= memoryPages) { |
IanBenzMaxim | 7:9cd16581b578 | 149 | return make_error_code(InvalidParameterError); |
IanBenzMaxim | 7:9cd16581b578 | 150 | } |
IanBenzMaxim | 7:9cd16581b578 | 151 | |
IanBenzMaxim | 7:9cd16581b578 | 152 | const size_t requestSize = 2 + Page::size; |
IanBenzMaxim | 7:9cd16581b578 | 153 | const size_t responseSize = 1 + 2 * Ecc256::Scalar::size; |
IanBenzMaxim | 7:9cd16581b578 | 154 | uint_least8_t buffer[MaximInterfaceCore_MAX(requestSize, responseSize)]; |
IanBenzMaxim | 7:9cd16581b578 | 155 | buffer[0] = 0xA5; |
IanBenzMaxim | 7:9cd16581b578 | 156 | buffer[1] = pageNum | (anonymous ? 0xE0 : 0x00); |
IanBenzMaxim | 7:9cd16581b578 | 157 | copy(challenge.begin(), challenge.end(), buffer + 2); |
IanBenzMaxim | 7:9cd16581b578 | 158 | span<uint_least8_t> response(buffer, responseSize); |
IanBenzMaxim | 7:9cd16581b578 | 159 | const error_code result = runCommand(make_span(buffer, requestSize), |
IanBenzMaxim | 7:9cd16581b578 | 160 | generateEcdsaSignatureTimeMs, response); |
IanBenzMaxim | 7:9cd16581b578 | 161 | if (!result) { |
IanBenzMaxim | 7:9cd16581b578 | 162 | span<uint_least8_t>::const_iterator begin = response.begin(); |
IanBenzMaxim | 7:9cd16581b578 | 163 | span<uint_least8_t>::const_iterator end = begin + signature.s.size(); |
IanBenzMaxim | 7:9cd16581b578 | 164 | copy(begin, end, signature.s.begin()); |
IanBenzMaxim | 7:9cd16581b578 | 165 | begin = end; |
IanBenzMaxim | 7:9cd16581b578 | 166 | end = begin + signature.r.size(); |
IanBenzMaxim | 7:9cd16581b578 | 167 | copy(begin, end, signature.r.begin()); |
IanBenzMaxim | 7:9cd16581b578 | 168 | } |
IanBenzMaxim | 7:9cd16581b578 | 169 | return result; |
IanBenzMaxim | 7:9cd16581b578 | 170 | } |
IanBenzMaxim | 7:9cd16581b578 | 171 | |
IanBenzMaxim | 7:9cd16581b578 | 172 | error_code DS28C39::disableDevice() { |
IanBenzMaxim | 7:9cd16581b578 | 173 | const uint_least8_t request[] = {0x33, 0x9E, 0xA7, 0x49, 0xFB, |
IanBenzMaxim | 7:9cd16581b578 | 174 | 0x10, 0x62, 0x0A, 0x26}; |
IanBenzMaxim | 7:9cd16581b578 | 175 | return runCommand(request, writeStateTimeMs); |
IanBenzMaxim | 7:9cd16581b578 | 176 | } |
IanBenzMaxim | 7:9cd16581b578 | 177 | |
IanBenzMaxim | 7:9cd16581b578 | 178 | error_code |
IanBenzMaxim | 7:9cd16581b578 | 179 | DS28C39::readDevicePublicKey(Ecc256::PublicKey::span devicePublicKey) { |
IanBenzMaxim | 7:9cd16581b578 | 180 | uint_least8_t buffer[1 + 2 * Ecc256::Scalar::size]; |
IanBenzMaxim | 7:9cd16581b578 | 181 | buffer[0] = 0xCB; |
IanBenzMaxim | 7:9cd16581b578 | 182 | span<uint_least8_t> response(buffer); |
IanBenzMaxim | 7:9cd16581b578 | 183 | const error_code result = |
IanBenzMaxim | 7:9cd16581b578 | 184 | runCommand(make_span(buffer, 1), generateEccKeyPairTimeMs, response); |
IanBenzMaxim | 7:9cd16581b578 | 185 | if (!result) { |
IanBenzMaxim | 7:9cd16581b578 | 186 | span<uint_least8_t>::const_iterator begin = response.begin(); |
IanBenzMaxim | 7:9cd16581b578 | 187 | span<uint_least8_t>::const_iterator end = begin + devicePublicKey.x.size(); |
IanBenzMaxim | 7:9cd16581b578 | 188 | copy(begin, end, devicePublicKey.x.begin()); |
IanBenzMaxim | 7:9cd16581b578 | 189 | begin = end; |
IanBenzMaxim | 7:9cd16581b578 | 190 | end = begin + devicePublicKey.y.size(); |
IanBenzMaxim | 7:9cd16581b578 | 191 | copy(begin, end, devicePublicKey.y.begin()); |
IanBenzMaxim | 7:9cd16581b578 | 192 | } |
IanBenzMaxim | 7:9cd16581b578 | 193 | return result; |
IanBenzMaxim | 7:9cd16581b578 | 194 | } |
IanBenzMaxim | 7:9cd16581b578 | 195 | |
IanBenzMaxim | 7:9cd16581b578 | 196 | error_code DS28C39::readRng(span<uint_least8_t> data) { |
IanBenzMaxim | 7:9cd16581b578 | 197 | const span<uint_least8_t>::index_type maxDataSize = 64; |
IanBenzMaxim | 7:9cd16581b578 | 198 | if ((data.size() < 1) || (data.size() > maxDataSize)) { |
IanBenzMaxim | 7:9cd16581b578 | 199 | return make_error_code(InvalidParameterError); |
IanBenzMaxim | 7:9cd16581b578 | 200 | } |
IanBenzMaxim | 7:9cd16581b578 | 201 | |
IanBenzMaxim | 7:9cd16581b578 | 202 | uint_least8_t buffer[1 + maxDataSize]; |
IanBenzMaxim | 7:9cd16581b578 | 203 | buffer[0] = 0xD2; |
IanBenzMaxim | 7:9cd16581b578 | 204 | buffer[1] = static_cast<uint_least8_t>(data.size() - 1); |
IanBenzMaxim | 7:9cd16581b578 | 205 | span<uint_least8_t> response(buffer, 1 + data.size()); |
IanBenzMaxim | 7:9cd16581b578 | 206 | const error_code result = |
IanBenzMaxim | 7:9cd16581b578 | 207 | runCommand(make_span(buffer, 2), trngGenerationTimeMs, response); |
IanBenzMaxim | 7:9cd16581b578 | 208 | if (!result) { |
IanBenzMaxim | 7:9cd16581b578 | 209 | copy(response.begin(), response.end(), data.begin()); |
IanBenzMaxim | 7:9cd16581b578 | 210 | } |
IanBenzMaxim | 7:9cd16581b578 | 211 | return result; |
IanBenzMaxim | 7:9cd16581b578 | 212 | } |
IanBenzMaxim | 7:9cd16581b578 | 213 | |
IanBenzMaxim | 7:9cd16581b578 | 214 | error_code |
IanBenzMaxim | 7:9cd16581b578 | 215 | DS28C39::authenticatePublicKey(Ecc256::Signature::const_span certificate, |
IanBenzMaxim | 7:9cd16581b578 | 216 | span<const uint_least8_t> customization) { |
IanBenzMaxim | 7:9cd16581b578 | 217 | static const span<const uint_least8_t>::index_type maxCustomizationSize = 32; |
IanBenzMaxim | 7:9cd16581b578 | 218 | static const span<const uint_least8_t>::index_type signatureSize = |
IanBenzMaxim | 7:9cd16581b578 | 219 | 2 * Ecc256::Scalar::size; |
IanBenzMaxim | 7:9cd16581b578 | 220 | |
IanBenzMaxim | 7:9cd16581b578 | 221 | if (customization.size() < 1 || customization.size() > maxCustomizationSize) { |
IanBenzMaxim | 7:9cd16581b578 | 222 | return make_error_code(InvalidParameterError); |
IanBenzMaxim | 7:9cd16581b578 | 223 | } |
IanBenzMaxim | 7:9cd16581b578 | 224 | |
IanBenzMaxim | 7:9cd16581b578 | 225 | uint_least8_t request[1 + signatureSize + maxCustomizationSize]; |
IanBenzMaxim | 7:9cd16581b578 | 226 | uint_least8_t * requestIt = request; |
IanBenzMaxim | 7:9cd16581b578 | 227 | *requestIt++ = 0x59; |
IanBenzMaxim | 7:9cd16581b578 | 228 | requestIt = copy(certificate.r.begin(), certificate.r.end(), requestIt); |
IanBenzMaxim | 7:9cd16581b578 | 229 | requestIt = copy(certificate.s.begin(), certificate.s.end(), requestIt); |
IanBenzMaxim | 7:9cd16581b578 | 230 | requestIt = copy(customization.begin(), customization.end(), requestIt); |
IanBenzMaxim | 7:9cd16581b578 | 231 | return runCommand(make_span(request, requestIt), verifyEcdsaSignatureTimeMs); |
IanBenzMaxim | 7:9cd16581b578 | 232 | } |
IanBenzMaxim | 7:9cd16581b578 | 233 | |
IanBenzMaxim | 7:9cd16581b578 | 234 | error_code |
IanBenzMaxim | 7:9cd16581b578 | 235 | DS28C39::authenticatedWriteMemory(int pageNum, Page::const_span page, |
IanBenzMaxim | 7:9cd16581b578 | 236 | Ecc256::Signature::const_span signature) { |
IanBenzMaxim | 7:9cd16581b578 | 237 | if (pageNum < 0 || pageNum >= memoryPages) { |
IanBenzMaxim | 7:9cd16581b578 | 238 | return make_error_code(InvalidParameterError); |
IanBenzMaxim | 7:9cd16581b578 | 239 | } |
IanBenzMaxim | 7:9cd16581b578 | 240 | |
IanBenzMaxim | 7:9cd16581b578 | 241 | uint_least8_t request[2 + Page::size + 2 * Ecc256::Scalar::size]; |
IanBenzMaxim | 7:9cd16581b578 | 242 | uint_least8_t * requestIt = request; |
IanBenzMaxim | 7:9cd16581b578 | 243 | *requestIt++ = 0x89; |
IanBenzMaxim | 7:9cd16581b578 | 244 | *requestIt++ = pageNum; |
IanBenzMaxim | 7:9cd16581b578 | 245 | requestIt = copy(page.begin(), page.end(), requestIt); |
IanBenzMaxim | 7:9cd16581b578 | 246 | requestIt = copy(signature.r.begin(), signature.r.end(), requestIt); |
IanBenzMaxim | 7:9cd16581b578 | 247 | copy(signature.s.begin(), signature.s.end(), requestIt); |
IanBenzMaxim | 7:9cd16581b578 | 248 | return runCommand(request, verifyEcdsaSignatureTimeMs + writeMemoryTimeMs); |
IanBenzMaxim | 7:9cd16581b578 | 249 | } |
IanBenzMaxim | 7:9cd16581b578 | 250 | |
IanBenzMaxim | 7:9cd16581b578 | 251 | error_code DS28C39::runCommand(span<const uint_least8_t> request, int delayTime, |
IanBenzMaxim | 7:9cd16581b578 | 252 | span<uint_least8_t> & response) { |
IanBenzMaxim | 7:9cd16581b578 | 253 | const span<const uint_least8_t>::index_type responseInputSize = |
IanBenzMaxim | 7:9cd16581b578 | 254 | response.size(); |
IanBenzMaxim | 7:9cd16581b578 | 255 | error_code result = doRunCommand(request, delayTime, response); |
IanBenzMaxim | 7:9cd16581b578 | 256 | if (result) { |
IanBenzMaxim | 7:9cd16581b578 | 257 | return result; |
IanBenzMaxim | 7:9cd16581b578 | 258 | } |
IanBenzMaxim | 7:9cd16581b578 | 259 | if (response.empty()) { |
IanBenzMaxim | 7:9cd16581b578 | 260 | return make_error_code(InvalidResponseError); |
IanBenzMaxim | 7:9cd16581b578 | 261 | } |
IanBenzMaxim | 7:9cd16581b578 | 262 | // Parse command result byte. |
IanBenzMaxim | 7:9cd16581b578 | 263 | switch (response[0]) { |
IanBenzMaxim | 7:9cd16581b578 | 264 | case 0xAA: |
IanBenzMaxim | 7:9cd16581b578 | 265 | // Success response. |
IanBenzMaxim | 7:9cd16581b578 | 266 | if (response.size() != responseInputSize) { |
IanBenzMaxim | 7:9cd16581b578 | 267 | result = make_error_code(InvalidResponseError); |
IanBenzMaxim | 7:9cd16581b578 | 268 | } |
IanBenzMaxim | 7:9cd16581b578 | 269 | break; |
IanBenzMaxim | 7:9cd16581b578 | 270 | |
IanBenzMaxim | 7:9cd16581b578 | 271 | case 0x00: |
IanBenzMaxim | 7:9cd16581b578 | 272 | result = make_error_code(AuthenticationError); |
IanBenzMaxim | 7:9cd16581b578 | 273 | break; |
IanBenzMaxim | 7:9cd16581b578 | 274 | |
IanBenzMaxim | 7:9cd16581b578 | 275 | default: |
IanBenzMaxim | 7:9cd16581b578 | 276 | result.assign(response[0], errorCategory()); |
IanBenzMaxim | 7:9cd16581b578 | 277 | break; |
IanBenzMaxim | 7:9cd16581b578 | 278 | } |
IanBenzMaxim | 7:9cd16581b578 | 279 | response = response.subspan(1); |
IanBenzMaxim | 7:9cd16581b578 | 280 | return result; |
IanBenzMaxim | 7:9cd16581b578 | 281 | } |
IanBenzMaxim | 7:9cd16581b578 | 282 | |
IanBenzMaxim | 7:9cd16581b578 | 283 | error_code DS28C39::runCommand(span<const uint_least8_t> request, |
IanBenzMaxim | 7:9cd16581b578 | 284 | int delayTime) { |
IanBenzMaxim | 7:9cd16581b578 | 285 | uint_least8_t buffer; |
IanBenzMaxim | 7:9cd16581b578 | 286 | span<uint_least8_t> response(&buffer, 1); |
IanBenzMaxim | 7:9cd16581b578 | 287 | return runCommand(request, delayTime, response); |
IanBenzMaxim | 7:9cd16581b578 | 288 | } |
IanBenzMaxim | 7:9cd16581b578 | 289 | |
IanBenzMaxim | 7:9cd16581b578 | 290 | const error_category & DS28C39::errorCategory() { |
IanBenzMaxim | 7:9cd16581b578 | 291 | static class : public error_category { |
IanBenzMaxim | 7:9cd16581b578 | 292 | public: |
IanBenzMaxim | 7:9cd16581b578 | 293 | virtual const char * name() const { return "DS28C39"; } |
IanBenzMaxim | 7:9cd16581b578 | 294 | |
IanBenzMaxim | 7:9cd16581b578 | 295 | virtual std::string message(int condition) const { |
IanBenzMaxim | 7:9cd16581b578 | 296 | switch (condition) { |
IanBenzMaxim | 7:9cd16581b578 | 297 | case InvalidOperationError: |
IanBenzMaxim | 7:9cd16581b578 | 298 | return "Invalid Operation Error"; |
IanBenzMaxim | 7:9cd16581b578 | 299 | |
IanBenzMaxim | 7:9cd16581b578 | 300 | case InvalidParameterError: |
IanBenzMaxim | 7:9cd16581b578 | 301 | return "Invalid Parameter Error"; |
IanBenzMaxim | 7:9cd16581b578 | 302 | |
IanBenzMaxim | 7:9cd16581b578 | 303 | case InvalidSequenceError: |
IanBenzMaxim | 7:9cd16581b578 | 304 | return "Invalid Sequence Error"; |
IanBenzMaxim | 7:9cd16581b578 | 305 | |
IanBenzMaxim | 7:9cd16581b578 | 306 | case InternalError: |
IanBenzMaxim | 7:9cd16581b578 | 307 | return "Internal Error"; |
IanBenzMaxim | 7:9cd16581b578 | 308 | |
IanBenzMaxim | 7:9cd16581b578 | 309 | case DeviceDisabledError: |
IanBenzMaxim | 7:9cd16581b578 | 310 | return "Device Disabled Error"; |
IanBenzMaxim | 7:9cd16581b578 | 311 | |
IanBenzMaxim | 7:9cd16581b578 | 312 | case AuthenticationError: |
IanBenzMaxim | 7:9cd16581b578 | 313 | return "Authentication Error"; |
IanBenzMaxim | 7:9cd16581b578 | 314 | |
IanBenzMaxim | 7:9cd16581b578 | 315 | case InvalidResponseError: |
IanBenzMaxim | 7:9cd16581b578 | 316 | return "Invalid Response Error"; |
IanBenzMaxim | 7:9cd16581b578 | 317 | } |
IanBenzMaxim | 7:9cd16581b578 | 318 | return defaultErrorMessage(condition); |
IanBenzMaxim | 7:9cd16581b578 | 319 | } |
IanBenzMaxim | 7:9cd16581b578 | 320 | } instance; |
IanBenzMaxim | 7:9cd16581b578 | 321 | return instance; |
IanBenzMaxim | 7:9cd16581b578 | 322 | } |
IanBenzMaxim | 7:9cd16581b578 | 323 | |
IanBenzMaxim | 7:9cd16581b578 | 324 | error_code readRomIdAndManId(DS28C39 & ds28c39, Core::RomId::span romId, |
IanBenzMaxim | 7:9cd16581b578 | 325 | Core::ManId::span manId) { |
IanBenzMaxim | 7:9cd16581b578 | 326 | DS28C39::Status status; |
IanBenzMaxim | 7:9cd16581b578 | 327 | const error_code result = ds28c39.readStatus(false, status); |
IanBenzMaxim | 7:9cd16581b578 | 328 | if (!result) { |
IanBenzMaxim | 7:9cd16581b578 | 329 | copy(make_span(status.romId), romId); |
IanBenzMaxim | 7:9cd16581b578 | 330 | copy(make_span(status.manId), manId); |
IanBenzMaxim | 7:9cd16581b578 | 331 | } |
IanBenzMaxim | 7:9cd16581b578 | 332 | return result; |
IanBenzMaxim | 7:9cd16581b578 | 333 | } |
IanBenzMaxim | 7:9cd16581b578 | 334 | |
IanBenzMaxim | 7:9cd16581b578 | 335 | DS28C39::PageAuthenticationData & |
IanBenzMaxim | 7:9cd16581b578 | 336 | DS28C39::PageAuthenticationData::setAnonymousRomId() { |
IanBenzMaxim | 7:9cd16581b578 | 337 | std::fill(romId().begin(), romId().end(), 0xFF); |
IanBenzMaxim | 7:9cd16581b578 | 338 | return *this; |
IanBenzMaxim | 7:9cd16581b578 | 339 | } |
IanBenzMaxim | 7:9cd16581b578 | 340 | |
IanBenzMaxim | 7:9cd16581b578 | 341 | } // namespace MaximInterfaceDevices |