76 lines
2.4 KiB
C
76 lines
2.4 KiB
C
|
// Copyright 2020 Espressif Systems (Shanghai) PTE LTD
|
||
|
|
//
|
||
|
|
// 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.
|
||
|
|
|
||
|
|
#include <string.h>
|
||
|
|
#include "esp32s2/rom/usb/usb_common.h"
|
||
|
|
#include "soc/soc.h"
|
||
|
|
#include "soc/efuse_reg.h"
|
||
|
|
|
||
|
|
/* USB CDC descriptor.
|
||
|
|
* Note that we aren't using the one in ROM since it doesn't
|
||
|
|
* set "serial" to the MAC address.
|
||
|
|
* However overriding the descriptor is cheap - we can reuse most
|
||
|
|
* of its components from ROM.
|
||
|
|
*/
|
||
|
|
|
||
|
|
/* This is not const, since the MAC address is only known at run time */
|
||
|
|
static struct string_descriptor s_str_serial_descr = {
|
||
|
|
.bLength = 2 + 2 * 17,
|
||
|
|
.bDescriptorType = 0x03,
|
||
|
|
.bString={'0', '0', ':', '0', '0', ':', '0', '0', ':', '0', '0', ':', '0', '0', ':', '0', '0'}
|
||
|
|
};
|
||
|
|
|
||
|
|
static const struct rom_usb_descriptors s_acm_usb_descriptors_override = {
|
||
|
|
.device_descr = &general_device_descr,
|
||
|
|
.config_descr = { &acm_config_descr },
|
||
|
|
.string_count = 4,
|
||
|
|
.string0_descr = &string0_descr,
|
||
|
|
.string_descrs = {
|
||
|
|
&str_manu_descr,
|
||
|
|
&str_prod_descr,
|
||
|
|
&s_str_serial_descr
|
||
|
|
}
|
||
|
|
};
|
||
|
|
|
||
|
|
static inline uint16_t nibble_to_hex_u16(uint8_t b)
|
||
|
|
{
|
||
|
|
if (b < 0xa) {
|
||
|
|
return '0' + b;
|
||
|
|
} else {
|
||
|
|
return 'a' + b - 0xa;
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
void rom_usb_cdc_set_descriptor_patch(void)
|
||
|
|
{
|
||
|
|
/* Get the MAC address */
|
||
|
|
const uint32_t mac0 = REG_GET_FIELD(EFUSE_RD_MAC_SPI_SYS_0_REG, EFUSE_MAC_0);
|
||
|
|
const uint32_t mac1 = REG_GET_FIELD(EFUSE_RD_MAC_SPI_SYS_1_REG, EFUSE_MAC_1);
|
||
|
|
uint8_t mac_bytes[6];
|
||
|
|
memcpy(mac_bytes, &mac0, 4);
|
||
|
|
memcpy(mac_bytes + 4, &mac1, 2);
|
||
|
|
|
||
|
|
/* Convert to UTF16 string */
|
||
|
|
uint16_t* dst = s_str_serial_descr.bString;
|
||
|
|
for (int i = 0; i < 6; ++i) {
|
||
|
|
uint8_t b = mac_bytes[5 - i]; /* printing from the MSB */
|
||
|
|
*dst++ = nibble_to_hex_u16(b >> 4);
|
||
|
|
*dst++ = nibble_to_hex_u16(b & 0xf);
|
||
|
|
dst++;
|
||
|
|
}
|
||
|
|
|
||
|
|
/* Override the pointer to descriptors structure */
|
||
|
|
rom_usb_curr_desc = &s_acm_usb_descriptors_override;
|
||
|
|
}
|