This commit is contained in:
Conor Patrick 2018-07-05 23:20:33 -04:00
parent 344a104ece
commit a18aa99220
19 changed files with 2863 additions and 88 deletions

File diff suppressed because one or more lines are too long

View File

@ -7,9 +7,11 @@
<property object="CRYOTIMER" propertyId="ABPeripheral.included" value="true"/> <property object="CRYOTIMER" propertyId="ABPeripheral.included" value="true"/>
<property object="CRYOTIMER" propertyId="cryotimer.clocking.eventafterevery" value="1 cycle"/> <property object="CRYOTIMER" propertyId="cryotimer.clocking.eventafterevery" value="1 cycle"/>
<property object="CRYOTIMER" propertyId="cryotimer.clocking.prescalerforcryotimer" value="Divide by 32"/> <property object="CRYOTIMER" propertyId="cryotimer.clocking.prescalerforcryotimer" value="Divide by 32"/>
<property object="CRYPTO" propertyId="ABPeripheral.included" value="true"/>
<property object="DefaultMode" propertyId="mode.diagramLocation" value="100, 100"/> <property object="DefaultMode" propertyId="mode.diagramLocation" value="100, 100"/>
<property object="EMU" propertyId="ABPeripheral.included" value="true"/> <property object="EMU" propertyId="ABPeripheral.included" value="true"/>
<property object="GPIO" propertyId="ABPeripheral.included" value="true"/> <property object="GPIO" propertyId="ABPeripheral.included" value="true"/>
<property object="LDMA" propertyId="ABPeripheral.included" value="true"/>
<property object="PA0" propertyId="ports.settings.pinmode" value="Push-pull"/> <property object="PA0" propertyId="ports.settings.pinmode" value="Push-pull"/>
<property object="PA1" propertyId="ports.settings.dout" value="1"/> <property object="PA1" propertyId="ports.settings.dout" value="1"/>
<property object="PA1" propertyId="ports.settings.filter" value="Enabled"/> <property object="PA1" propertyId="ports.settings.filter" value="Enabled"/>

1822
efm32/emlib/em_crypto.c Normal file

File diff suppressed because it is too large Load Diff

278
efm32/inc/crypto-config.h Normal file
View File

@ -0,0 +1,278 @@
/*
* Configuration for enabling CRYPTO hardware acceleration in all mbedtls
* modules when running on SiliconLabs devices.
*
* Copyright (C) 2016, Silicon Labs, http://www.silabs.com
* SPDX-License-Identifier: Apache-2.0
*
* Licensed under the Apache License, Version 2.0 (the "License"); you may
* not use this file except in compliance with the License.
* You may obtain a copy of the License at
*
* http://www.apache.org/licenses/LICENSE-2.0
*
* Unless required by applicable law or agreed to in writing, software
* distributed under the License is distributed on an "AS IS" BASIS, WITHOUT
* WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
* See the License for the specific language governing permissions and
* limitations under the License.
*/
/**
* @defgroup sl_crypto_config Silicon Labs CRYPTO Hardware Acceleration Configuration
* @addtogroup sl_crypto_config
*
* @brief
* mbed TLS configuration for Silicon Labs CRYPTO hardware acceleration
*
* @details
* mbed TLS configuration is composed of settings in this Silicon Labs specific CRYPTO hardware acceleration file located in mbedtls/configs and the mbed TLS configuration file in mbedtls/include/mbedtls/config.h.
* This configuration can be used as a starting point to evaluate hardware acceleration available on Silicon Labs devices.
*
* @{
*/
#ifndef MBEDTLS_CONFIG_SL_CRYPTO_ALL_ACCELERATION_H
#define MBEDTLS_CONFIG_SL_CRYPTO_ALL_ACCELERATION_H
#include "em_device.h"
#if !defined(NO_CRYPTO_ACCELERATION)
/**
* @name SECTION: Silicon Labs Acceleration settings
*
* This section sets Silicon Labs Acceleration settings.
* @{
*/
/**
* \def MBEDTLS_AES_ALT
*
* Enable hardware acceleration for the AES block cipher
*
* Module: sl_crypto/src/crypto_aes.c for devices with CRYPTO
* sl_crypto/src/aes_aes.c for devices with AES
*
* See MBEDTLS_AES_C for more information.
*/
#define MBEDTLS_AES_ALT
#define MBEDTLS_ECP_ALT
/**
* \def MBEDTLS_ECP_INTERNAL_ALT
* \def ECP_SHORTWEIERSTRASS
* \def MBEDTLS_ECP_ADD_MIXED_ALT
* \def MBEDTLS_ECP_DOUBLE_JAC_ALT
* \def MBEDTLS_ECP_NORMALIZE_JAC_MANY_ALT
* \def MBEDTLS_ECP_NORMALIZE_JAC_ALT
*
* Enable hardware acceleration for the elliptic curve over GF(p) library.
*
* Module: sl_crypto/src/crypto_ecp.c
* Caller: library/ecp.c
*
* Requires: MBEDTLS_BIGNUM_C, MBEDTLS_ECP_C and at least one
* MBEDTLS_ECP_DP_XXX_ENABLED and (CRYPTO_COUNT > 0)
*/
#if defined(CRYPTO_COUNT) && (CRYPTO_COUNT > 0)
#define MBEDTLS_ECP_INTERNAL_ALT
#define ECP_SHORTWEIERSTRASS
#define MBEDTLS_ECP_ADD_MIXED_ALT
#define MBEDTLS_ECP_DOUBLE_JAC_ALT
#define MBEDTLS_ECP_NORMALIZE_JAC_MANY_ALT
#define MBEDTLS_ECP_NORMALIZE_JAC_ALT
#define MBEDTLS_ECP_RANDOMIZE_JAC_ALT
#endif
/**
* \def MBEDTLS_SHA1_ALT
*
* Enable hardware acceleration for the SHA1 cryptographic hash algorithm.
*
* Module: sl_crypto/src/crypto_sha.c
* Caller: library/mbedtls_md.c
* library/ssl_cli.c
* library/ssl_srv.c
* library/ssl_tls.c
* library/x509write_crt.c
*
* Requires: MBEDTLS_SHA1_C and (CRYPTO_COUNT > 0)
* See MBEDTLS_SHA1_C for more information.
*/
#if defined(CRYPTO_COUNT) && (CRYPTO_COUNT > 0)
#define MBEDTLS_SHA1_ALT
#endif
/**
* \def MBEDTLS_SHA256_ALT
*
* Enable hardware acceleration for the SHA-224 and SHA-256 cryptographic
* hash algorithms.
*
* Module: sl_crypto/src/crypto_sha.c
* Caller: library/entropy.c
* library/mbedtls_md.c
* library/ssl_cli.c
* library/ssl_srv.c
* library/ssl_tls.c
*
* Requires: MBEDTLS_SHA256_C and (CRYPTO_COUNT > 0)
* See MBEDTLS_SHA256_C for more information.
*/
#if defined(CRYPTO_COUNT) && (CRYPTO_COUNT > 0)
#define MBEDTLS_SHA256_ALT
#endif
#endif /* #if !defined(NO_CRYPTO_ACCELERATION) */
/**
* \def MBEDTLS_TRNG_C
*
* Enable software support for the True Random Number Generator (TRNG)
* incorporated from Series 1 Configuration 2 devices (EFR32MG12, etc.)
* from Silicon Labs.
*
* TRNG is not supported by software for EFR32XG13 (SDID_89) and
* EFR32XG14 (SDID_95).
*
* Requires TRNG_PRESENT &&
* !(_SILICON_LABS_GECKO_INTERNAL_SDID_89 ||
* _SILICON_LABS_GECKO_INTERNAL_SDID_95)
*/
#if defined(TRNG_PRESENT) && \
!(defined(_SILICON_LABS_GECKO_INTERNAL_SDID_89) || \
defined(_SILICON_LABS_GECKO_INTERNAL_SDID_95))
#define MBEDTLS_TRNG_C
#endif
/**
* \def MBEDTLS_ENTROPY_ADC_C
*
* Enable software support for the retrieving entropy data from the ADC
* incorporated on devices from Silicon Labs.
*
* Requires ADC_PRESENT && _ADC_SINGLECTRLX_VREFSEL_VENTROPY
*/
#if defined(ADC_PRESENT) && defined(_ADC_SINGLECTRLX_VREFSEL_VENTROPY)
#define MBEDTLS_ENTROPY_ADC_C
#endif
/**
* \def MBEDTLS_ENTROPY_ADC_INSTANCE
*
* Specify which ADC instance shall be used as entropy source.
*
* Requires MBEDTLS_ENTROPY_ADC_C
*/
#if defined(MBEDTLS_ENTROPY_ADC_C)
#define MBEDTLS_ENTROPY_ADC_INSTANCE (0)
#endif
/**
* \def MBEDTLS_ENTROPY_RAIL_C
*
* Enable software support for the retrieving entropy data from the RAIL
* incorporated on devices from Silicon Labs.
*
* Requires _EFR_DEVICE
*/
#if defined(_EFR_DEVICE)
#define MBEDTLS_ENTROPY_RAIL_C
#endif
/**
* \def MBEDTLS_ENTROPY_HARDWARE_ALT_RAIL
*
* Use the radio (RAIL) as default hardware entropy source.
*
* Requires MBEDTLS_ENTROPY_RAIL_C && _EFR_DEVICE && !MBEDTLS_TRNG_C
*/
#if defined(MBEDTLS_ENTROPY_RAIL_C) && \
defined(_EFR_DEVICE) && !defined(MBEDTLS_TRNG_C)
#define MBEDTLS_ENTROPY_HARDWARE_ALT_RAIL
#endif
/**
* \def MBEDTLS_ENTROPY_HARDWARE_ALT
*
* Integrate the provided default entropy source into the mbed
* TLS entropy infrastructure.
*
* Requires MBEDTLS_TRNG_C || MBEDTLS_ENTROPY_HARDWARE_ALT_RAIL
*/
#if defined(MBEDTLS_TRNG_C) || defined(MBEDTLS_ENTROPY_HARDWARE_ALT_RAIL)
#define MBEDTLS_ENTROPY_HARDWARE_ALT
#endif
/* Default ECC configuration for Silicon Labs devices: */
/* ECC curves supported by CRYPTO hardware module: */
#define MBEDTLS_ECP_DP_SECP192R1_ENABLED
#define MBEDTLS_ECP_DP_SECP224R1_ENABLED
#define MBEDTLS_ECP_DP_SECP256R1_ENABLED
/* Save RAM by adjusting to our exact needs */
#define MBEDTLS_ECP_MAX_BITS 256
#ifndef MBEDTLS_MPI_MAX_SIZE
#define MBEDTLS_MPI_MAX_SIZE 32 // 384 bits is 48 bytes
#endif
/*
Set MBEDTLS_ECP_WINDOW_SIZE to configure
ECC point multiplication window size, see ecp.h:
2 = Save RAM at the expense of speed
3 = Improve speed at the expense of RAM
4 = Optimize speed at the expense of RAM
*/
#define MBEDTLS_ECP_WINDOW_SIZE 3
#define MBEDTLS_ECP_FIXED_POINT_OPTIM 0
/* Significant speed benefit at the expense of some ROM */
#define MBEDTLS_ECP_NIST_OPTIM
/* Include the default mbed TLS config file */
#include "mbedtls/config.h"
#undef MBEDTLS_TIMING_C
#undef MBEDTLS_FS_IO
#undef MBEDTLS_SHA512_C
#undef MBEDTLS_ENTROPY_SHA512_ACCUMULATOR
#undef MBEDTLS_NET_C
#define MBEDTLS_ECP_NORMALIZE_JAC_ALT
#define MBEDTLS_ECP_DEVICE_ALT
#define MBEDTLS_MPI_MODULAR_DIVISION_ALT
#define MBEDTLS_ECP_INTERNAL_ALT
#define ECP_SHORTWEIERSTRASS
#define MBEDTLS_ECP_ADD_MIXED_ALT
#define MBEDTLS_ECP_DOUBLE_JAC_ALT
#define MBEDTLS_ECP_NORMALIZE_JAC_MANY_ALT
#define MBEDTLS_ECP_NORMALIZE_JAC_ALT
#define MBEDTLS_ECP_RANDOMIZE_JAC_ALT
#define MBEDTLS_ECP_DEVICE_ADD_MIXED_ALT
//#define MBEDTLS_MPI_MUL_MPI_ALT // doesnt seem to be implemented
//#define MBEDTLS_MPI_MUL_INT_ALT // makes no difference or slightly slower
#define MBEDTLS_NO_PLATFORM_ENTROPY
/* Hardware entropy source is not yet supported. Uncomment this macro to
provide your own implementation of an entropy collector. */
//#define MBEDTLS_ENTROPY_HARDWARE_ALT
/* Exclude and/or change default config here. E.g.: */
//#undef MBEDTLS_ECP_DP_SECP384R1_ENABLED
//#undef MBEDTLS_ECP_DP_SECP521R1_ENABLED
//#undef MBEDTLS_ECP_DP_BP384R1_ENABLED
//#undef MBEDTLS_ECP_DP_BP512R1_ENABLED
//#undef MBEDTLS_SHA512_C
#include "mbedtls/check_config.h"
/** @} (end section sl_crypto_config) */
/** @} (end addtogroup sl_crypto_config) */
#endif /* MBEDTLS_CONFIG_SL_CRYPTO_ALL_ACCELERATION_H */

View File

@ -20,7 +20,9 @@
#include "em_chip.h" #include "em_chip.h"
#include "em_assert.h" #include "em_assert.h"
#include "em_cryotimer.h" #include "em_cryotimer.h"
#include "em_crypto.h"
#include "em_gpio.h" #include "em_gpio.h"
#include "em_ldma.h"
#include "em_usart.h" #include "em_usart.h"
// [Library includes]$ // [Library includes]$
@ -35,6 +37,7 @@ extern void enter_DefaultMode_from_RESET(void) {
CMU_enter_DefaultMode_from_RESET(); CMU_enter_DefaultMode_from_RESET();
USART0_enter_DefaultMode_from_RESET(); USART0_enter_DefaultMode_from_RESET();
USART1_enter_DefaultMode_from_RESET(); USART1_enter_DefaultMode_from_RESET();
LDMA_enter_DefaultMode_from_RESET();
CRYOTIMER_enter_DefaultMode_from_RESET(); CRYOTIMER_enter_DefaultMode_from_RESET();
PORTIO_enter_DefaultMode_from_RESET(); PORTIO_enter_DefaultMode_from_RESET();
// [Config Calls]$ // [Config Calls]$
@ -127,6 +130,9 @@ extern void CMU_enter_DefaultMode_from_RESET(void) {
/* Enable clock for CRYOTIMER */ /* Enable clock for CRYOTIMER */
CMU_ClockEnable(cmuClock_CRYOTIMER, true); CMU_ClockEnable(cmuClock_CRYOTIMER, true);
/* Enable clock for LDMA */
CMU_ClockEnable(cmuClock_LDMA, true);
/* Enable clock for USART0 */ /* Enable clock for USART0 */
CMU_ClockEnable(cmuClock_USART0, true); CMU_ClockEnable(cmuClock_USART0, true);

547
efm32/src/crypto.c Normal file
View File

@ -0,0 +1,547 @@
/*
* Wrapper for crypto implementation on device
*
* */
#include <stdio.h>
#include <stdlib.h>
#include <string.h>
#include "util.h"
#include "crypto.h"
#include "sha256.h"
#include "uECC.h"
#include "aes.h"
#include "ctap.h"
#include MBEDTLS_CONFIG_FILE
#include "sha256_alt.h"
#include "mbedtls/ctr_drbg.h"
#include "mbedtls/ecdsa.h"
const uint8_t attestation_cert_der[];
const uint16_t attestation_cert_der_size;
const uint8_t attestation_key[];
const uint16_t attestation_key_size;
static SHA256_CTX sha256_ctx;
mbedtls_sha256_context embed_sha256_ctx;
static const struct uECC_Curve_t * _es256_curve = NULL;
static const uint8_t * _signing_key = NULL;
// Secrets for testing only
static uint8_t master_secret[32] = "\x00\x11\x22\x33\x44\x55\x66\x77\x88\x99\xaa\xbb\xcc\xdd\xee\xff"
"\xff\xee\xdd\xcc\xbb\xaa\x99\x88\x77\x66\x55\x44\x33\x22\x11\x00";
static uint8_t transport_secret[32] = "\x10\x01\x22\x33\x44\x55\x66\x77\x87\x90\x0a\xbb\x3c\xd8\xee\xff"
"\xff\xee\x8d\x1c\x3b\xfa\x99\x88\x77\x86\x55\x44\xd3\xff\x33\x00";
void crypto_sha256_init()
{
mbedtls_sha256_init( &embed_sha256_ctx );
mbedtls_sha256_starts(&embed_sha256_ctx,0);
// sha256_init(&sha256_ctx);
}
void crypto_reset_master_secret()
{
ctap_generate_rng(master_secret, 32);
}
void crypto_sha256_update(uint8_t * data, size_t len)
{
mbedtls_sha256_update(&embed_sha256_ctx,data,len);
// sha256_update(&sha256_ctx, data, len);
}
void crypto_sha256_update_secret()
{
mbedtls_sha256_update(&embed_sha256_ctx,master_secret,32);
// sha256_update(&sha256_ctx, master_secret, 32);
}
void crypto_sha256_final(uint8_t * hash)
{
mbedtls_sha256_finish( &embed_sha256_ctx, hash );
// sha256_final(&sha256_ctx, hash);
}
void crypto_sha256_hmac_init(uint8_t * key, uint32_t klen, uint8_t * hmac)
{
uint8_t buf[64];
int i;
memset(buf, 0, sizeof(buf));
if (key == CRYPTO_MASTER_KEY)
{
key = master_secret;
klen = sizeof(master_secret);
}
if(klen > 64)
{
printf("Error, key size must be <= 64\n");
exit(1);
}
memmove(buf, key, klen);
for (i = 0; i < sizeof(buf); i++)
{
buf[i] = buf[i] ^ 0x36;
}
crypto_sha256_init();
crypto_sha256_update(buf, 64);
}
void crypto_sha256_hmac_final(uint8_t * key, uint32_t klen, uint8_t * hmac)
{
uint8_t buf[64];
int i;
crypto_sha256_final(hmac);
memset(buf, 0, sizeof(buf));
if (key == CRYPTO_MASTER_KEY)
{
key = master_secret;
klen = sizeof(master_secret);
}
if(klen > 64)
{
printf("Error, key size must be <= 64\n");
exit(1);
}
memmove(buf, key, klen);
for (i = 0; i < sizeof(buf); i++)
{
buf[i] = buf[i] ^ 0x5c;
}
crypto_sha256_init();
crypto_sha256_update(buf, 64);
crypto_sha256_update(hmac, 32);
crypto_sha256_final(hmac);
}
mbedtls_ctr_drbg_context ctr_drbg;
void crypto_ecc256_init()
{
uECC_set_rng((uECC_RNG_Function)ctap_generate_rng);
_es256_curve = uECC_secp256r1();
mbedtls_ctr_drbg_init(&ctr_drbg);
}
void crypto_ecc256_load_attestation_key()
{
_signing_key = attestation_key;
}
/**
* \brief Import a point from unsigned binary data
*
* \param grp Group to which the point should belong
* \param P Point to import
* \param buf Input buffer
* \param ilen Actual length of input
*
* \return 0 if successful,
* MBEDTLS_ERR_ECP_BAD_INPUT_DATA if input is invalid,
* MBEDTLS_ERR_MPI_ALLOC_FAILED if memory allocation failed,
* MBEDTLS_ERR_ECP_FEATURE_UNAVAILABLE if the point format
* is not implemented.
*
* \note This function does NOT check that the point actually
* belongs to the given group, see mbedtls_ecp_check_pubkey() for
* that.
*/
//int mbedtls_ecp_point_read_binary( const mbedtls_ecp_group *grp, mbedtls_ecp_point *P,
// const unsigned char *buf, size_t ilen );
/**
* \brief Import X from unsigned binary data, big endian
*
* \param X Destination MPI
* \param buf Input buffer
* \param buflen Input buffer size
*
* \return 0 if successful,
* MBEDTLS_ERR_MPI_ALLOC_FAILED if memory allocation failed
*/
//int mbedtls_mpi_read_binary( mbedtls_mpi *X, const unsigned char *buf, size_t buflen );
/*
* Set context from an mbedtls_ecp_keypair
*/
//int mbedtls_ecdsa_from_keypair( mbedtls_ecdsa_context *ctx, const mbedtls_ecp_keypair *key );
void crypto_ecc256_sign(uint8_t * data, int len, uint8_t * sig)
{
mbedtls_ecp_group grp; /*!< Elliptic curve and base point */
mbedtls_mpi d; /*!< our secret value */
//#define CRYPTO_ENABLE CMU->HFBUSCLKEN0 |= CMU_HFBUSCLKEN0_CRYPTO; \
// CRYPTO->IFC = _CRYPTO_IFC_MASK; \
// CRYPTO->CMD = CRYPTO_CMD_SEQSTOP; \
// CRYPTO->CTRL = CRYPTO_CTRL_DMA0RSEL_DDATA0; \
// CRYPTO->SEQCTRL = 0; \
// CRYPTO->SEQCTRLB = 0
//
//#define CRYPTO_DISABLE \
// CRYPTO->IEN = 0; \
// CMU->HFBUSCLKEN0 &= ~CMU_HFBUSCLKEN0_CRYPTO;
// CRYPTO_DISABLE;
// CRYPTO_ENABLE;
mbedtls_ecp_group_init( &grp );
mbedtls_mpi_init( &d );
mbedtls_ecp_group_load(&grp, MBEDTLS_ECP_DP_SECP256R1);
mbedtls_mpi_read_binary(&d, _signing_key, 32);
mbedtls_mpi r,s;
mbedtls_mpi_init(&r);
mbedtls_mpi_init(&s);
printf("signing..\n");
dump_hex(data,len);
mbedtls_ecdsa_sign_det( &grp, &r, &s, &d,
data, 32, MBEDTLS_MD_SHA256 );// Issue: this will freeze on 13th iteration..
printf("signed\n");
mbedtls_mpi_write_binary(&r,sig,32);
mbedtls_mpi_write_binary(&s,sig+32,32);
// if ( uECC_sign(_signing_key, data, len, sig, _es256_curve) == 0)
// {
// printf("error, uECC failed\n");
// exit(1);
// }
}
/*
* Generate a keypair with configurable base point
*/
// mbedtls_ecp_gen_keypair( &ctx->grp, &ctx->d, &ctx->Q, f_rng, p_rng )
// mbedtls_ecp_gen_keypair_base( grp, &grp->G, d, Q, f_rng, p_rng )
/*
* Curve types: internal for now, might be exposed later
*/
typedef enum
{
ECP_TYPE_NONE = 0,
ECP_TYPE_SHORT_WEIERSTRASS, /* y^2 = x^3 + a x + b */
ECP_TYPE_MONTGOMERY, /* y^2 = x^3 + a x^2 + x */
} ecp_curve_type;
/*
* Get the type of a curve
*/
static inline ecp_curve_type ecp_get_type( const mbedtls_ecp_group *grp )
{
if( grp->G.X.p == NULL )
return( ECP_TYPE_NONE );
if( grp->G.Y.p == NULL )
return( ECP_TYPE_MONTGOMERY );
else
return( ECP_TYPE_SHORT_WEIERSTRASS );
}
static int mbedtls_ecp_gen_privkey( mbedtls_ecp_group *grp,
const mbedtls_ecp_point *G,
mbedtls_mpi *d, mbedtls_ecp_point *Q,
int (*f_rng)(void *, unsigned char *, size_t),
void *p_rng )
{
int ret;
size_t n_size = ( grp->nbits + 7 ) / 8;
#if defined(ECP_MONTGOMERY)
if( ecp_get_type( grp ) == ECP_TYPE_MONTGOMERY )
{
/* [M225] page 5 */
size_t b;
MBEDTLS_MPI_CHK( mbedtls_mpi_fill_random( d, n_size, f_rng, p_rng ) );
/* Make sure the most significant bit is nbits */
b = mbedtls_mpi_bitlen( d ) - 1; /* mbedtls_mpi_bitlen is one-based */
if( b > grp->nbits )
MBEDTLS_MPI_CHK( mbedtls_mpi_shift_r( d, b - grp->nbits ) );
else
MBEDTLS_MPI_CHK( mbedtls_mpi_set_bit( d, grp->nbits, 1 ) );
/* Make sure the last three bits are unset */
MBEDTLS_MPI_CHK( mbedtls_mpi_set_bit( d, 0, 0 ) );
MBEDTLS_MPI_CHK( mbedtls_mpi_set_bit( d, 1, 0 ) );
MBEDTLS_MPI_CHK( mbedtls_mpi_set_bit( d, 2, 0 ) );
}
else
#endif /* ECP_MONTGOMERY */
#if defined(ECP_SHORTWEIERSTRASS)
if( ecp_get_type( grp ) == ECP_TYPE_SHORT_WEIERSTRASS )
{
/* SEC1 3.2.1: Generate d such that 1 <= n < N */
int count = 0;
unsigned char rnd[MBEDTLS_ECP_MAX_BYTES];
/*
* Match the procedure given in RFC 6979 (deterministic ECDSA):
* - use the same byte ordering;
* - keep the leftmost nbits bits of the generated octet string;
* - try until result is in the desired range.
* This also avoids any biais, which is especially important for ECDSA.
*/
do
{
MBEDTLS_MPI_CHK( f_rng( p_rng, rnd, n_size ) );
MBEDTLS_MPI_CHK( mbedtls_mpi_read_binary( d, rnd, n_size ) );
MBEDTLS_MPI_CHK( mbedtls_mpi_shift_r( d, 8 * n_size - grp->nbits ) );
/*
* Each try has at worst a probability 1/2 of failing (the msb has
* a probability 1/2 of being 0, and then the result will be < N),
* so after 30 tries failure probability is a most 2**(-30).
*
* For most curves, 1 try is enough with overwhelming probability,
* since N starts with a lot of 1s in binary, but some curves
* such as secp224k1 are actually very close to the worst case.
*/
if( ++count > 30 )
return( MBEDTLS_ERR_ECP_RANDOM_FAILED );
}
while( mbedtls_mpi_cmp_int( d, 1 ) < 0 ||
mbedtls_mpi_cmp_mpi( d, &grp->N ) >= 0 );
}
else
#endif /* ECP_SHORTWEIERSTRASS */
return( MBEDTLS_ERR_ECP_BAD_INPUT_DATA );
cleanup:
if( ret != 0 )
return( ret );
return 0;
}
static int mbedtls_ecp_derive_pubkey( mbedtls_ecp_group *grp,
const mbedtls_ecp_point *G,
mbedtls_mpi *d, mbedtls_ecp_point *Q,
int (*f_rng)(void *, unsigned char *, size_t),
void *p_rng )
{
return( mbedtls_ecp_mul( grp, Q, d, G, f_rng, p_rng ) );
}
static int hmac_vector_func(uint8_t * hmac, uint8_t * dst, int len)
{
static int hmac_ptr = 0;
if (hmac==NULL)
{
hmac_ptr = 0;
return 0;
}
int i;
while(len--)
{
*dst++ = hmac[hmac_ptr++ % 32];
}
return 0;
}
void generate_private_key(uint8_t * data, int len, uint8_t * data2, int len2, uint8_t * privkey)
{
crypto_sha256_hmac_init(CRYPTO_MASTER_KEY, 0, privkey);
crypto_sha256_update(data, len);
crypto_sha256_update(data2, len2);
crypto_sha256_update(master_secret, 32);
crypto_sha256_hmac_final(CRYPTO_MASTER_KEY, 0, privkey);
mbedtls_ecp_group grp; /*!< Elliptic curve and base point */
mbedtls_mpi d; /*!< our secret value */
mbedtls_ecp_point Q;
mbedtls_ecp_group_init( &grp );
mbedtls_mpi_init( &d );
mbedtls_ecp_point_init(&Q);
mbedtls_ecp_group_load(&grp, MBEDTLS_ECP_DP_SECP256R1);
// mbedtls_mpi_read_binary(&d, _signing_key, 32);
hmac_vector_func(NULL, NULL, 0);
mbedtls_ecp_gen_privkey(&grp, &grp.G, &d, &Q, hmac_vector_func, privkey);
mbedtls_mpi_write_binary(&d,privkey,32);
}
/*int uECC_compute_public_key(const uint8_t *private_key, uint8_t *public_key, uECC_Curve curve);*/
void crypto_ecc256_derive_public_key(uint8_t * data, int len, uint8_t * x, uint8_t * y)
{
int ret;
uint8_t privkey[32];
uint8_t pubkey[64];
// generate_private_key(data,len,NULL,0,privkey);
crypto_sha256_hmac_init(CRYPTO_MASTER_KEY, 0, privkey);
crypto_sha256_update(data, len);
crypto_sha256_update(NULL, 0);
crypto_sha256_update(master_secret, 32);
crypto_sha256_hmac_final(CRYPTO_MASTER_KEY, 0, privkey);
mbedtls_ecp_group grp; /*!< Elliptic curve and base point */
mbedtls_mpi d; /*!< our secret value */
mbedtls_ecp_point Q;
mbedtls_ecp_group_init( &grp );
mbedtls_mpi_init( &d );
mbedtls_ecp_point_init(&Q);
mbedtls_ecp_group_load(&grp, MBEDTLS_ECP_DP_SECP256R1);
// mbedtls_mpi_read_binary(&d, _signing_key, 32);
hmac_vector_func(NULL, NULL, 0);
ret= mbedtls_ecp_gen_privkey(&grp, &grp.G, &d, &Q, hmac_vector_func, privkey);
if (ret != 0)
{
printf("error with priv key -0x04%x\n", -ret);
}
// mbedtls_mpi_write_binary(&d,privkey,32);
memset(pubkey,0,sizeof(pubkey));
ret = mbedtls_ecp_derive_pubkey( &grp, &grp.G,
&d, &Q, hmac_vector_func, privkey);
if (ret != 0)
{
printf("error with public key\n");
}
mbedtls_mpi_write_binary(&Q.X,x,32);
mbedtls_mpi_write_binary(&Q.Y,y,32);
// uECC_compute_public_key(privkey, pubkey, _es256_curve);
// memmove(x,pubkey,32);
// memmove(y,pubkey+32,32);
}
void crypto_ecc256_load_key(uint8_t * data, int len, uint8_t * data2, int len2)
{
static uint8_t privkey[32];
generate_private_key(data,len,data2,len2,privkey);
_signing_key = privkey;
}
void crypto_ecc256_make_key_pair(uint8_t * pubkey, uint8_t * privkey)
{
if (uECC_make_key(pubkey, privkey, _es256_curve) != 1)
{
printf("Error, uECC_make_key failed\n");
exit(1);
}
}
void crypto_ecc256_shared_secret(const uint8_t * pubkey, const uint8_t * privkey, uint8_t * shared_secret)
{
if (uECC_shared_secret(pubkey, privkey, shared_secret, _es256_curve) != 1)
{
printf("Error, uECC_shared_secret failed\n");
exit(1);
}
}
struct AES_ctx aes_ctx;
void crypto_aes256_init(uint8_t * key, uint8_t * nonce)
{
if (key == CRYPTO_TRANSPORT_KEY)
{
AES_init_ctx(&aes_ctx, transport_secret);
}
else
{
AES_init_ctx(&aes_ctx, key);
}
if (nonce == NULL)
{
memset(aes_ctx.Iv, 0, 16);
}
else
{
memmove(aes_ctx.Iv, nonce, 16);
}
}
// prevent round key recomputation
void crypto_aes256_reset_iv(uint8_t * nonce)
{
if (nonce == NULL)
{
memset(aes_ctx.Iv, 0, 16);
}
else
{
memmove(aes_ctx.Iv, nonce, 16);
}
}
void crypto_aes256_decrypt(uint8_t * buf, int length)
{
AES_CBC_decrypt_buffer(&aes_ctx, buf, length);
}
void crypto_aes256_encrypt(uint8_t * buf, int length)
{
AES_CBC_encrypt_buffer(&aes_ctx, buf, length);
}
const uint8_t attestation_cert_der[] =
"\x30\x82\x01\xfb\x30\x82\x01\xa1\xa0\x03\x02\x01\x02\x02\x01\x00\x30\x0a\x06\x08"
"\x2a\x86\x48\xce\x3d\x04\x03\x02\x30\x2c\x31\x0b\x30\x09\x06\x03\x55\x04\x06\x13"
"\x02\x55\x53\x31\x0b\x30\x09\x06\x03\x55\x04\x08\x0c\x02\x4d\x44\x31\x10\x30\x0e"
"\x06\x03\x55\x04\x0a\x0c\x07\x54\x45\x53\x54\x20\x43\x41\x30\x20\x17\x0d\x31\x38"
"\x30\x35\x31\x30\x30\x33\x30\x36\x32\x30\x5a\x18\x0f\x32\x30\x36\x38\x30\x34\x32"
"\x37\x30\x33\x30\x36\x32\x30\x5a\x30\x7c\x31\x0b\x30\x09\x06\x03\x55\x04\x06\x13"
"\x02\x55\x53\x31\x0b\x30\x09\x06\x03\x55\x04\x08\x0c\x02\x4d\x44\x31\x0f\x30\x0d"
"\x06\x03\x55\x04\x07\x0c\x06\x4c\x61\x75\x72\x65\x6c\x31\x15\x30\x13\x06\x03\x55"
"\x04\x0a\x0c\x0c\x54\x45\x53\x54\x20\x43\x4f\x4d\x50\x41\x4e\x59\x31\x22\x30\x20"
"\x06\x03\x55\x04\x0b\x0c\x19\x41\x75\x74\x68\x65\x6e\x74\x69\x63\x61\x74\x6f\x72"
"\x20\x41\x74\x74\x65\x73\x74\x61\x74\x69\x6f\x6e\x31\x14\x30\x12\x06\x03\x55\x04"
"\x03\x0c\x0b\x63\x6f\x6e\x6f\x72\x70\x70\x2e\x63\x6f\x6d\x30\x59\x30\x13\x06\x07"
"\x2a\x86\x48\xce\x3d\x02\x01\x06\x08\x2a\x86\x48\xce\x3d\x03\x01\x07\x03\x42\x00"
"\x04\x45\xa9\x02\xc1\x2e\x9c\x0a\x33\xfa\x3e\x84\x50\x4a\xb8\x02\xdc\x4d\xb9\xaf"
"\x15\xb1\xb6\x3a\xea\x8d\x3f\x03\x03\x55\x65\x7d\x70\x3f\xb4\x02\xa4\x97\xf4\x83"
"\xb8\xa6\xf9\x3c\xd0\x18\xad\x92\x0c\xb7\x8a\x5a\x3e\x14\x48\x92\xef\x08\xf8\xca"
"\xea\xfb\x32\xab\x20\xa3\x62\x30\x60\x30\x46\x06\x03\x55\x1d\x23\x04\x3f\x30\x3d"
"\xa1\x30\xa4\x2e\x30\x2c\x31\x0b\x30\x09\x06\x03\x55\x04\x06\x13\x02\x55\x53\x31"
"\x0b\x30\x09\x06\x03\x55\x04\x08\x0c\x02\x4d\x44\x31\x10\x30\x0e\x06\x03\x55\x04"
"\x0a\x0c\x07\x54\x45\x53\x54\x20\x43\x41\x82\x09\x00\xf7\xc9\xec\x89\xf2\x63\x94"
"\xd9\x30\x09\x06\x03\x55\x1d\x13\x04\x02\x30\x00\x30\x0b\x06\x03\x55\x1d\x0f\x04"
"\x04\x03\x02\x04\xf0\x30\x0a\x06\x08\x2a\x86\x48\xce\x3d\x04\x03\x02\x03\x48\x00"
"\x30\x45\x02\x20\x18\x38\xb0\x45\x03\x69\xaa\xa7\xb7\x38\x62\x01\xaf\x24\x97\x5e"
"\x7e\x74\x64\x1b\xa3\x7b\xf7\xe6\xd3\xaf\x79\x28\xdb\xdc\xa5\x88\x02\x21\x00\xcd"
"\x06\xf1\xe3\xab\x16\x21\x8e\xd8\xc0\x14\xaf\x09\x4f\x5b\x73\xef\x5e\x9e\x4b\xe7"
"\x35\xeb\xdd\x9b\x6d\x8f\x7d\xf3\xc4\x3a\xd7";
const uint16_t attestation_cert_der_size = sizeof(attestation_cert_der)-1;
const uint8_t attestation_key[] = "\xcd\x67\xaa\x31\x0d\x09\x1e\xd1\x6e\x7e\x98\x92\xaa\x07\x0e\x19\x94\xfc\xd7\x14\xae\x7c\x40\x8f\xb9\x46\xb7\x2e\x5f\xe7\x5d\x30";
const uint16_t attestation_key_size = sizeof(attestation_key)-1;

View File

@ -71,10 +71,11 @@ void heartbeat()
static int beat = 0; static int beat = 0;
GPIO_PinOutToggle(gpioPortF,4); GPIO_PinOutToggle(gpioPortF,4);
GPIO_PinOutToggle(gpioPortF,5); GPIO_PinOutToggle(gpioPortF,5);
// printf("heartbeat %d\r\n", CRYOTIMER->CNT);
// printf("heartbeat %d %d\r\n", beat++,CRYOTIMER->CNT);
} }
uint64_t millis() uint32_t millis()
{ {
return CRYOTIMER->CNT; return CRYOTIMER->CNT;
} }
@ -96,11 +97,11 @@ int usbhid_recv(uint8_t * msg)
for (i = 0; i < 64; i++) for (i = 0; i < 64; i++)
{ {
msg[i] = USART_SpiTransfer(USART1, 0); msg[i] = USART_SpiTransfer(USART1, 0);
delay(1); // delay(1);
} }
msgs_to_recv--; msgs_to_recv--;
// printf(">> "); printf(">> ");
// dump_hex(msg,64); dump_hex(msg,64);
return 64; return 64;
} }
@ -110,12 +111,25 @@ int usbhid_recv(uint8_t * msg)
void usbhid_send(uint8_t * msg) void usbhid_send(uint8_t * msg)
{ {
int i; int i;
uint64_t t1 = millis();
GPIO_PinModeSet(gpioPortC, 10, gpioModeInput, 0);
// Wait for efm8 to be ready
while (GPIO_PinInGet(gpioPortC, 10) == 0)
;
GPIO_PinModeSet(gpioPortC, 10, gpioModePushPull, 0);
uint64_t t2 = millis();
// printf("wait time: %ul\n", (uint32_t)(t2-t1));
GPIO_PinOutSet(gpioPortC,10); GPIO_PinOutSet(gpioPortC,10);
for (i = 0; i < HID_MESSAGE_SIZE; i++) for (i = 0; i < HID_MESSAGE_SIZE; i++)
{ {
USART_SpiTransfer(USART1, *msg++); USART_SpiTransfer(USART1, *msg++);
} }
GPIO_PinOutClear(gpioPortC,10); GPIO_PinOutClear(gpioPortC,10);
} }
void usbhid_close() void usbhid_close()
@ -168,10 +182,7 @@ void device_init(void)
1); 1);
// SPI R/W indicator // SPI R/W indicator
GPIO_PinModeSet(gpioPortC, GPIO_PinModeSet(gpioPortC, 10, gpioModePushPull, 0);
10,
gpioModePushPull,
0);
// USB message rdy ext int // USB message rdy ext int
GPIO_ExtIntConfig(gpioPortC, 9, 9, 1, 0,1); GPIO_ExtIntConfig(gpioPortC, 9, 9, 1, 0,1);

View File

@ -170,7 +170,7 @@
<storageModule moduleId="org.eclipse.cdt.core.externalSettings"/> <storageModule moduleId="org.eclipse.cdt.core.externalSettings"/>
</cconfiguration> </cconfiguration>
</storageModule> </storageModule>
<storageModule moduleId="com.silabs.ss.framework.ide.project.core.cpp" project.generation="56" projectCommon.boardIds="brd5000a:0.0.0.A02" projectCommon.buildArtifactType="EXE" projectCommon.importModeId="COPY" projectCommon.partId="mcu.8051.efm8.ub1.efm8ub10f16g-b-qfn28" projectCommon.sdkId="com.silabs.sdk.8051:4.1.1._-963069327"/> <storageModule moduleId="com.silabs.ss.framework.ide.project.core.cpp" project.generation="70" projectCommon.boardIds="brd5000a:0.0.0.A02" projectCommon.buildArtifactType="EXE" projectCommon.importModeId="COPY" projectCommon.partId="mcu.8051.efm8.ub1.efm8ub10f16g-b-qfn28" projectCommon.sdkId="com.silabs.sdk.8051:4.1.1._-963069327"/>
<storageModule moduleId="cdtBuildSystem" version="4.0.0"> <storageModule moduleId="cdtBuildSystem" version="4.0.0">
<project id="efm8.com.silabs.ss.framework.ide.project.core.cdt.cdtMbsProjectType.972220390" name="SLS CDT Project" projectType="com.silabs.ss.framework.ide.project.core.cdt.cdtMbsProjectType"/> <project id="efm8.com.silabs.ss.framework.ide.project.core.cdt.cdtMbsProjectType.972220390" name="SLS CDT Project" projectType="com.silabs.ss.framework.ide.project.core.cdt.cdtMbsProjectType"/>
</storageModule> </storageModule>

View File

@ -25,6 +25,7 @@
<property object="P0.7" propertyId="ports.settings.outputmode" value="Push-pull"/> <property object="P0.7" propertyId="ports.settings.outputmode" value="Push-pull"/>
<property object="P1.1" propertyId="ports.settings.iomode" value="Digital Push-Pull Output"/> <property object="P1.1" propertyId="ports.settings.iomode" value="Digital Push-Pull Output"/>
<property object="P1.1" propertyId="ports.settings.outputmode" value="Push-pull"/> <property object="P1.1" propertyId="ports.settings.outputmode" value="Push-pull"/>
<property object="P1.2" propertyId="ports.settings.latch" value="Low"/>
<property object="P1.4" propertyId="ports.settings.iomode" value="Digital Push-Pull Output"/> <property object="P1.4" propertyId="ports.settings.iomode" value="Digital Push-Pull Output"/>
<property object="P1.4" propertyId="ports.settings.outputmode" value="Push-pull"/> <property object="P1.4" propertyId="ports.settings.outputmode" value="Push-pull"/>
<property object="P1.5" propertyId="ports.settings.iomode" value="Digital Push-Pull Output"/> <property object="P1.5" propertyId="ports.settings.iomode" value="Digital Push-Pull Output"/>
@ -77,16 +78,27 @@
<property object="USBLIB_0" propertyId="configuration.configurationparameters.devicepower" value="Bus-Powered"/> <property object="USBLIB_0" propertyId="configuration.configurationparameters.devicepower" value="Bus-Powered"/>
<property object="USBLIB_0" propertyId="device.deviceproperties.bmaxpacketsize" value="64"/> <property object="USBLIB_0" propertyId="device.deviceproperties.bmaxpacketsize" value="64"/>
<property object="USBLIB_0" propertyId="device.deviceproperties.productidpid" value="35535"/> <property object="USBLIB_0" propertyId="device.deviceproperties.productidpid" value="35535"/>
<property object="USBLIB_0" propertyId="device.deviceproperties.productstring" value="EOS Wallet"/> <property object="USBLIB_0" propertyId="device.deviceproperties.productstring" value="EOS Bridge"/>
<property object="USBLIB_0" propertyId="endpoints.endpoint1in.bulkmaxpacketsizebytes" value="64"/> <property object="USBLIB_0" propertyId="endpoints.endpoint1in.bulkmaxpacketsizebytes" value="64"/>
<property object="USBLIB_0" propertyId="endpoints.endpoint1in.endpoint1in" value="Enabled"/>
<property object="USBLIB_0" propertyId="endpoints.endpoint1in.maxpacketsizebytes" value="64"/> <property object="USBLIB_0" propertyId="endpoints.endpoint1in.maxpacketsizebytes" value="64"/>
<property object="USBLIB_0" propertyId="endpoints.endpoint1in.pollingintervalms" value="5"/> <property object="USBLIB_0" propertyId="endpoints.endpoint1in.pollingintervalms" value="5"/>
<property object="USBLIB_0" propertyId="endpoints.endpoint1in.transfertype" value="Interrupt"/> <property object="USBLIB_0" propertyId="endpoints.endpoint1in.transfertype" value="Interrupt"/>
<property object="USBLIB_0" propertyId="endpoints.endpoint1out.endpoint1out" value="Enabled"/>
<property object="USBLIB_0" propertyId="endpoints.endpoint1out.maxpacketsizebytes" value="64"/> <property object="USBLIB_0" propertyId="endpoints.endpoint1out.maxpacketsizebytes" value="64"/>
<property object="USBLIB_0" propertyId="endpoints.endpoint1out.pollingintervalms" value="5"/> <property object="USBLIB_0" propertyId="endpoints.endpoint1out.pollingintervalms" value="5"/>
<property object="USBLIB_0" propertyId="endpoints.endpoint1out.transfertype" value="Interrupt"/> <property object="USBLIB_0" propertyId="endpoints.endpoint1out.transfertype" value="Interrupt"/>
<property object="USBLIB_0" propertyId="endpoints.endpoint2in.bulkmaxpacketsizebytes" value="64"/>
<property object="USBLIB_0" propertyId="endpoints.endpoint2in.maxpacketsizebytes" value="64"/>
<property object="USBLIB_0" propertyId="endpoints.endpoint2in.pollingintervalms" value="5"/>
<property object="USBLIB_0" propertyId="endpoints.endpoint2in.transfertype" value="Interrupt"/>
<property object="USBLIB_0" propertyId="endpoints.endpoint2out.bulkmaxpacketsizebytes" value="64"/>
<property object="USBLIB_0" propertyId="endpoints.endpoint2out.endpoint2out" value="Enabled"/>
<property object="USBLIB_0" propertyId="endpoints.endpoint2out.maxpacketsizebytes" value="64"/>
<property object="USBLIB_0" propertyId="endpoints.endpoint2out.pollingintervalms" value="5"/>
<property object="USBLIB_0" propertyId="endpoints.endpoint2out.transfertype" value="Interrupt"/>
<property object="USBLIB_0" propertyId="endpoints.endpoint3in.endpoint3in" value="Enabled"/>
<property object="USBLIB_0" propertyId="endpoints.endpoint3in.maxpacketsizebytes" value="64"/>
<property object="USBLIB_0" propertyId="endpoints.endpoint3in.pollingintervalms" value="5"/>
<property object="USBLIB_0" propertyId="endpoints.endpoint3in.transfertype" value="Interrupt"/>
<property object="USBLIB_0" propertyId="interfaces.interface0.interfaceclass" value="HID (Human Interface Device)"/> <property object="USBLIB_0" propertyId="interfaces.interface0.interfaceclass" value="HID (Human Interface Device)"/>
<property object="USBLIB_0" propertyId="library.callbackfunctions.resetcallback" value="Enabled"/> <property object="USBLIB_0" propertyId="library.callbackfunctions.resetcallback" value="Enabled"/>
<property object="USBLIB_0" propertyId="library.callbackfunctions.selfpoweredcallback" value="Enabled"/> <property object="USBLIB_0" propertyId="library.callbackfunctions.selfpoweredcallback" value="Enabled"/>

View File

@ -8,7 +8,7 @@
#ifndef INC_APP_H_ #ifndef INC_APP_H_
#define INC_APP_H_ #define INC_APP_H_
//#define USE_PRINTING #define USE_PRINTING
void usb_transfer_complete(); void usb_transfer_complete();
void spi_transfer_complete(); void spi_transfer_complete();

View File

@ -53,11 +53,11 @@
// Enable or disable each endpoint // Enable or disable each endpoint
// ----------------------------------------------------------------------------- // -----------------------------------------------------------------------------
// $[Endpoints Used] // $[Endpoints Used]
#define SLAB_USB_EP1IN_USED 1 #define SLAB_USB_EP1IN_USED 0
#define SLAB_USB_EP1OUT_USED 1 #define SLAB_USB_EP1OUT_USED 0
#define SLAB_USB_EP2IN_USED 0 #define SLAB_USB_EP2IN_USED 0
#define SLAB_USB_EP2OUT_USED 0 #define SLAB_USB_EP2OUT_USED 1
#define SLAB_USB_EP3IN_USED 0 #define SLAB_USB_EP3IN_USED 1
#define SLAB_USB_EP3OUT_USED 0 #define SLAB_USB_EP3OUT_USED 0
// [Endpoints Used]$ // [Endpoints Used]$
@ -67,9 +67,9 @@
// $[Endpoint Max Packet Size] // $[Endpoint Max Packet Size]
#define SLAB_USB_EP1IN_MAX_PACKET_SIZE 64 #define SLAB_USB_EP1IN_MAX_PACKET_SIZE 64
#define SLAB_USB_EP1OUT_MAX_PACKET_SIZE 64 #define SLAB_USB_EP1OUT_MAX_PACKET_SIZE 64
#define SLAB_USB_EP2IN_MAX_PACKET_SIZE 1 #define SLAB_USB_EP2IN_MAX_PACKET_SIZE 64
#define SLAB_USB_EP2OUT_MAX_PACKET_SIZE 1 #define SLAB_USB_EP2OUT_MAX_PACKET_SIZE 64
#define SLAB_USB_EP3IN_MAX_PACKET_SIZE 1 #define SLAB_USB_EP3IN_MAX_PACKET_SIZE 64
#define SLAB_USB_EP3OUT_MAX_PACKET_SIZE 1 #define SLAB_USB_EP3OUT_MAX_PACKET_SIZE 1
// [Endpoint Max Packet Size]$ // [Endpoint Max Packet Size]$
@ -79,9 +79,9 @@
// $[Endpoint Transfer Type] // $[Endpoint Transfer Type]
#define SLAB_USB_EP1IN_TRANSFER_TYPE USB_EPTYPE_INTR #define SLAB_USB_EP1IN_TRANSFER_TYPE USB_EPTYPE_INTR
#define SLAB_USB_EP1OUT_TRANSFER_TYPE USB_EPTYPE_INTR #define SLAB_USB_EP1OUT_TRANSFER_TYPE USB_EPTYPE_INTR
#define SLAB_USB_EP2IN_TRANSFER_TYPE USB_EPTYPE_BULK #define SLAB_USB_EP2IN_TRANSFER_TYPE USB_EPTYPE_INTR
#define SLAB_USB_EP2OUT_TRANSFER_TYPE USB_EPTYPE_BULK #define SLAB_USB_EP2OUT_TRANSFER_TYPE USB_EPTYPE_INTR
#define SLAB_USB_EP3IN_TRANSFER_TYPE USB_EPTYPE_ISOC #define SLAB_USB_EP3IN_TRANSFER_TYPE USB_EPTYPE_INTR
#define SLAB_USB_EP3OUT_TRANSFER_TYPE USB_EPTYPE_ISOC #define SLAB_USB_EP3OUT_TRANSFER_TYPE USB_EPTYPE_ISOC
// [Endpoint Transfer Type]$ // [Endpoint Transfer Type]$

View File

@ -407,6 +407,18 @@ extern void PORTS_0_enter_DefaultMode_from_RESET(void) {
extern void PORTS_1_enter_DefaultMode_from_RESET(void) { extern void PORTS_1_enter_DefaultMode_from_RESET(void) {
// $[P1 - Port 1 Pin Latch] // $[P1 - Port 1 Pin Latch]
/***********************************************************************
- P1.0 is high. Set P1.0 to drive or float high
- P1.1 is high. Set P1.1 to drive or float high
- P1.2 is low. Set P1.2 to drive low
- P1.3 is high. Set P1.3 to drive or float high
- P1.4 is high. Set P1.4 to drive or float high
- P1.5 is high. Set P1.5 to drive or float high
- P1.6 is high. Set P1.6 to drive or float high
- P1.7 is high. Set P1.7 to drive or float high
***********************************************************************/
P1 = P1_B0__HIGH | P1_B1__HIGH | P1_B2__LOW | P1_B3__HIGH | P1_B4__HIGH
| P1_B5__HIGH | P1_B6__HIGH | P1_B7__HIGH;
// [P1 - Port 1 Pin Latch]$ // [P1 - Port 1 Pin Latch]$
// $[P1MDOUT - Port 1 Output Mode] // $[P1MDOUT - Port 1 Output Mode]

View File

@ -147,10 +147,14 @@ uint16_t USBD_XferCompleteCb(uint8_t epAddr, USB_Status_TypeDef status,
UNUSED(xferred); UNUSED(xferred);
UNUSED(remaining); UNUSED(remaining);
if (epAddr == EP1OUT) if (epAddr == EP2OUT)
{ {
usb_transfer_complete(); usb_transfer_complete();
} }
else if (epAddr == EP3IN)
{
usb_writeback_complete();
}
return 0; return 0;
} }

View File

@ -104,19 +104,19 @@ SI_SEGMENT_VARIABLE(configDesc[],
sizeof( ReportDescriptor0 ),// wDescriptorLength(LSB) sizeof( ReportDescriptor0 ),// wDescriptorLength(LSB)
sizeof( ReportDescriptor0 )>>8,// wDescriptorLength(MSB) sizeof( ReportDescriptor0 )>>8,// wDescriptorLength(MSB)
//Endpoint 1 IN Descriptor //Endpoint 2 IN Descriptor
USB_ENDPOINT_DESCSIZE,// bLength USB_ENDPOINT_DESCSIZE,// bLength
USB_ENDPOINT_DESCRIPTOR,// bDescriptorType USB_ENDPOINT_DESCRIPTOR,// bDescriptorType
0x81,// bEndpointAddress 0x83,// bEndpointAddress
USB_EPTYPE_INTR,// bAttrib USB_EPTYPE_INTR,// bAttrib
HID_PACKET_SIZE,// wMaxPacketSize (LSB) HID_PACKET_SIZE,// wMaxPacketSize (LSB)
0x00,// wMaxPacketSize (MSB) 0x00,// wMaxPacketSize (MSB)
5,// bInterval 5,// bInterval
//Endpoint 1 OUT Descriptor //Endpoint 3 OUT Descriptor
USB_ENDPOINT_DESCSIZE,// bLength USB_ENDPOINT_DESCSIZE,// bLength
USB_ENDPOINT_DESCRIPTOR,// bDescriptorType USB_ENDPOINT_DESCRIPTOR,// bDescriptorType
0x01,// bEndpointAddress 0x02,// bEndpointAddress
USB_EPTYPE_INTR,// bAttrib USB_EPTYPE_INTR,// bAttrib
HID_PACKET_SIZE,// wMaxPacketSize (LSB) HID_PACKET_SIZE,// wMaxPacketSize (LSB)
0x00,// wMaxPacketSize (MSB) 0x00,// wMaxPacketSize (MSB)

View File

@ -4,7 +4,10 @@
#include "uart_1.h" #include "uart_1.h"
#include "printing.h" #include "printing.h"
#define BUFFER_SIZE 13 #define BUFFER_SIZE 12
#define SIGNAL_WRITE_BSY() P1 = P1 & (~(1<<2)) // Set P1 low
#define SIGNAL_WRITE_RDY() P1 = P1 | (1<<2) // Set P1 high
data uint8_t write_ptr = 0; data uint8_t write_ptr = 0;
data uint8_t read_ptr = 0; data uint8_t read_ptr = 0;
@ -12,20 +15,28 @@ data uint8_t i_ptr = 0;
data uint8_t count = 0; data uint8_t count = 0;
data uint8_t writebackbuf_count = 0; data uint8_t writebackbuf_count = 0;
uint8_t hidmsgbuf[64][BUFFER_SIZE]; uint8_t hidmsgbuf[64*BUFFER_SIZE];
//uint8_t debugR[64];
//uint8_t debugRi;
//uint8_t debugW[64];
//uint8_t debugW2[64];
//uint8_t debugWi;
data uint8_t writebackbuf[64]; data uint8_t writebackbuf[64];
void usb_transfer_complete() void usb_transfer_complete()
{ {
count++; count++;
// memmove(debugR, hidmsgbuf + write_ptr*64, 64);
// debugRi = write_ptr;
write_ptr++; write_ptr++;
if (write_ptr == BUFFER_SIZE) if (write_ptr == BUFFER_SIZE)
{ {
write_ptr = 0; write_ptr = 0;
} }
if (count == 1 && i_ptr == 0) if (count == 1 && i_ptr == 0)
{ {
SPI0DAT = hidmsgbuf[read_ptr][i_ptr++]; SPI0DAT = (hidmsgbuf+read_ptr*64)[i_ptr++];
} }
@ -34,27 +45,48 @@ void usb_transfer_complete()
} }
uint16_t USB_TX_COUNT = 0;
void usb_writeback_complete()
{
if (USB_TX_COUNT >= 511/2)
{
USB_TX_COUNT -= 64;
if (USB_TX_COUNT < 511)
{
SIGNAL_WRITE_RDY();
}
}
else
{
USB_TX_COUNT -= 64;
}
}
void spi_transfer_complete() void spi_transfer_complete()
{ {
count--; count--;
i_ptr = 0; i_ptr = 0;
SPI0FCN0 |= (1<<2); // Flush rx fifo buffer SPI0FCN0 |= (1<<2); // Flush rx fifo buffer
if (count)
{ // debugWi = read_ptr;
SPI0DAT = hidmsgbuf[read_ptr][i_ptr++];
}
read_ptr++; read_ptr++;
if (read_ptr == BUFFER_SIZE) if (read_ptr == BUFFER_SIZE)
{ {
read_ptr = 0; read_ptr = 0;
} }
if (count)
{
SPI0DAT = (hidmsgbuf+read_ptr*64)[i_ptr++];
}
// cprints("sent hid msg\r\n"); // cprints("sent hid msg\r\n");
} }
data int overrun = 0;
SI_INTERRUPT (SPI0_ISR, SPI0_IRQn) SI_INTERRUPT (SPI0_ISR, SPI0_IRQn)
{ {
data uint8_t byt;
if (SPI0CN0_WCOL == 1) if (SPI0CN0_WCOL == 1)
{ {
// Write collision occurred // Write collision occurred
@ -65,14 +97,22 @@ SI_INTERRUPT (SPI0_ISR, SPI0_IRQn)
{ {
// Receive overrun occurred // Receive overrun occurred
SPI0CN0_RXOVRN = 0; SPI0CN0_RXOVRN = 0;
overrun = 1;
// cprints("SPI0CN0_RXOVRN\r\n"); // cprints("SPI0CN0_RXOVRN\r\n");
} }
else else
{ {
if (EFM32_RW_PIN) if (EFM32_RW_PIN)
{ {
if (writebackbuf_count < 64) writebackbuf[writebackbuf_count++] = SPI0DAT; if (writebackbuf_count < 64)
else cprints("overflow\r\n"); {
writebackbuf[writebackbuf_count++] = SPI0DAT;
SIGNAL_WRITE_BSY();
}
else
{
cprints("overflow\r\n");
}
} }
else else
{ {
@ -80,8 +120,12 @@ SI_INTERRUPT (SPI0_ISR, SPI0_IRQn)
{ {
if (i_ptr < 64) if (i_ptr < 64)
{ {
SPI0DAT = hidmsgbuf[read_ptr][i_ptr++]; // debugW[i_ptr] = (hidmsgbuf+read_ptr*64)[i_ptr];
// debugW2[i_ptr] = read_ptr;
// if (i_ptr == 63)
// debugW2[i_ptr] = 0xaa;
SPI0DAT = (hidmsgbuf+read_ptr*64)[i_ptr++];
byt = SPI0DAT;
} }
else else
{ {
@ -97,7 +141,8 @@ SI_INTERRUPT (SPI0_ISR, SPI0_IRQn)
void usb_write() void usb_write()
{ {
data uint8_t errors = 0; data uint8_t errors = 0;
while (USB_STATUS_OK != (USBD_Write(EP1IN, writebackbuf, 64, false))) USB_TX_COUNT += 64;
while (USB_STATUS_OK != (USBD_Write(EP3IN, writebackbuf, 64, true)))
{ {
delay(2); delay(2);
if (errors++ > 30) if (errors++ > 30)
@ -131,6 +176,8 @@ int main(void) {
IE_EA = 1; IE_EA = 1;
IE_ESPI0 = 1; IE_ESPI0 = 1;
SIGNAL_WRITE_RDY();
cprints("hello,world\r\n"); cprints("hello,world\r\n");
reset = RSTSRC; reset = RSTSRC;
@ -138,21 +185,30 @@ int main(void) {
while (1) { while (1) {
// delay(1500); // delay(1500);
if (overrun)
{
cprints("O\r\n");
overrun = 0;
}
if (millis() - t1 > 1500) if (millis() - t1 > 1500)
{ {
P1_B5 = k++&1; P1_B5 = k++&1;
// if (k&1)
// SIGNAL_WRITE_RDY();
// else
// SIGNAL_WRITE_BSY();
t1 = millis(); t1 = millis();
} }
if (!USBD_EpIsBusy(EP1OUT) && !USBD_EpIsBusy(EP1IN)) if (!USBD_EpIsBusy(EP2OUT) && !USBD_EpIsBusy(EP3IN) && lastcount==count)
{ {
// cprintd("sched read to ",1,reset); // cprintd("sched read to ",1,(int)(hidmsgbuf + write_ptr*64));
if (count == BUFFER_SIZE) if (count == BUFFER_SIZE)
{ {
cprints("Warning, USB buffer full\r\n"); // cprints("Warning, USB buffer full\r\n");
} }
else else
{ {
USBD_Read(EP1OUT, hidmsgbuf[write_ptr], 64, true); USBD_Read(EP2OUT, hidmsgbuf + write_ptr*64, 64, true);
} }
} }
@ -160,26 +216,31 @@ int main(void) {
{ {
// cprints("<< "); // cprints("<< ");
// dump_hex(writebackbuf,64); // dump_hex(writebackbuf,64);
writebackbuf_count = 0;
// while (USBD_EpIsBusy(EP1IN)) // while (USBD_EpIsBusy(EP1IN))
// ; // ;
usb_write(); usb_write();
writebackbuf_count = 0;
if (USB_TX_COUNT < 511/2)
{
SIGNAL_WRITE_RDY();
}
} }
if (lastcount != count) if (lastcount != count)
{ {
if (count > lastcount) if (count > lastcount)
{ {
// cprints(">> "); // cputd(debugRi); cprints(">> ");
// dump_hex(writebackbuf,64); // dump_hex(debugR,64);
MSG_RDY_INT_PIN = 0; MSG_RDY_INT_PIN = 0;
MSG_RDY_INT_PIN = 1; MSG_RDY_INT_PIN = 1;
} }
else else
{ {
// cprints("efm32 read hid msg\r\n>> "); // cputd(debugWi); cprints(">>>> ");
// dump_hex(debug,64); // dump_hex(debugW,64);
// dump_hex(debugW2,64);
} }
lastcount = count; lastcount = count;
} }

View File

@ -42,6 +42,7 @@ void dump_hex(uint8_t* hex, uint8_t len)
putf(lut[b]); putf(lut[b]);
b = ((*hex) & 0x0f); b = ((*hex) & 0x0f);
putf(lut[b]); putf(lut[b]);
putf(' ');
hex++; hex++;
} }
cprints("\r\n"); cprints("\r\n");

View File

@ -361,6 +361,7 @@ void ctaphid_handle_packet(uint8_t * pkt_raw)
uint32_t newcid; uint32_t newcid;
static CTAPHID_WRITE_BUFFER wb; static CTAPHID_WRITE_BUFFER wb;
uint32_t active_cid; uint32_t active_cid;
uint32_t t1,t2;
CTAP_RESPONSE ctap_resp; CTAP_RESPONSE ctap_resp;
@ -542,9 +543,13 @@ void ctaphid_handle_packet(uint8_t * pkt_raw)
wb.cmd = CTAPHID_CBOR; wb.cmd = CTAPHID_CBOR;
wb.bcnt = (ctap_resp.length+1); wb.bcnt = (ctap_resp.length+1);
t1 = millis();
ctaphid_write(&wb, &status, 1); ctaphid_write(&wb, &status, 1);
ctaphid_write(&wb, ctap_resp.data, ctap_resp.length); ctaphid_write(&wb, ctap_resp.data, ctap_resp.length);
ctaphid_write(&wb, NULL, 0); ctaphid_write(&wb, NULL, 0);
t2 = millis();
printf1(TAG_TIME,"CBOR writeback: %d ms\n",(uint32_t)(t2-t1));
break; break;
case CTAPHID_MSG: case CTAPHID_MSG:

View File

@ -3,7 +3,7 @@
void device_init(); void device_init();
uint64_t millis(); uint32_t millis();
// HID message size in bytes // HID message size in bytes
#define HID_MESSAGE_SIZE 64 #define HID_MESSAGE_SIZE 64

View File

@ -5,7 +5,7 @@
#include "cbor.h" #include "cbor.h"
#include "device.h" #include "device.h"
#include "ctaphid.h" #include "ctaphid.h"
#include "bsp.h" //#include "bsp.h"
#include "util.h" #include "util.h"
#include "log.h" #include "log.h"
#include "ctap.h" #include "ctap.h"
@ -16,23 +16,24 @@
int main(int argc, char * argv[]) int main(int argc, char * argv[])
{ {
int count = 0; int count = 0;
uint64_t t1 = 0; uint32_t t1 = 0;
uint64_t t2 = 0; uint32_t t2 = 0;
uint64_t accum = 0; uint32_t accum = 0;
uint32_t dt = 0;
uint8_t hidmsg[64]; uint8_t hidmsg[64];
set_logging_mask( set_logging_mask(
/*0*/ /*0*/
TAG_GEN| // TAG_GEN|
/*TAG_MC |*/ /*TAG_MC |*/
/*TAG_GA |*/ /*TAG_GA |*/
/*TAG_CP |*/ /*TAG_CP |*/
TAG_CTAP| // TAG_CTAP|
TAG_HID| // TAG_HID|
/*TAG_U2F|*/ /*TAG_U2F|*/
/*TAG_PARSE |*/ /*TAG_PARSE |*/
/*TAG_TIME|*/ TAG_TIME|
TAG_DUMP| // TAG_DUMP|
/*TAG_GREEN|*/ /*TAG_GREEN|*/
/*TAG_RED|*/ /*TAG_RED|*/
TAG_ERR TAG_ERR
@ -67,7 +68,9 @@ int main(int argc, char * argv[])
t2 = millis(); t2 = millis();
ctaphid_handle_packet(hidmsg); ctaphid_handle_packet(hidmsg);
accum += millis() - t2; accum += millis() - t2;
printf1(TAG_TIME,"accum: %lu\n", (uint32_t)accum); printf1(TAG_TIME,"accum: %d\n", (uint32_t)accum);
printf1(TAG_TIME,"dt: %d\n", t2 - dt);
dt = t2;
memset(hidmsg, 0, sizeof(hidmsg)); memset(hidmsg, 0, sizeof(hidmsg));
} }
else else