ble: Wait with setting the product string to after orientation

usb_processing wasn't being setup until AFTER usb was enabled. This was
a problem beacuse the app is so fast that it manages to send the first
requests over ble before usb is setup.

Since "usb_processing" is unrelated to the usb driver, we initialize it
before we initialize the usb driver.

Author: NickeZ

src/bootloader/bootloader.c

@@ -1022,7 +1022,8 @@ void bootloader_jump(void)
     util_log("Not jumping to firmware");
     _compute_is_app_flash_empty();
     _render_default_screen();
-    if (usb_start(_api_setup) != ERR_NONE) {
+    _api_setup();
+    if (usb_start() != ERR_NONE) {
         _render_message("Failed to initialize USB", 0);
     }
 }

src/bootloader/startup.c

@@ -85,10 +85,16 @@ int main(void)
     uint16_t uart_read_buf_len = 0;
 
     ringbuffer_init(&uart_write_queue, &uart_write_buf, UART_OUT_BUF_LEN);
-#define DEVICE_MODE "{\"p\":\"bb02p-bl-multi\",\"v\":\"1.1.0\"}"
-    da14531_set_product(DEVICE_MODE, sizeof(DEVICE_MODE) - 1, &uart_write_queue);
     bool usb_hww_request_seen = false;
 
+    // Set product to bootloader string, this is necessary if we have rebooted from firmware. Must
+    // be done after usb_processing is initalized to avoid getting request from the app to early.
+#define DEVICE_MODE "{\"p\":\"bb02p-bl-multi\",\"v\":\"1.1.0\"}"
+    da14531_handler_current_product = (const uint8_t*)DEVICE_MODE;
+    da14531_handler_current_product_len = sizeof(DEVICE_MODE) - 1;
+    da14531_set_product(
+        da14531_handler_current_product, da14531_handler_current_product_len, &uart_write_queue);
+
     da14531_protocol_init();
 #endif
     usb_processing_init();

src/da14531/da14531.c

@@ -45,11 +45,16 @@ void da14531_power_down(struct ringbuffer* uart_out)
     }
 }
 
-void da14531_set_product(const char* product, uint16_t product_len, struct ringbuffer* uart_out)
+void da14531_set_product(
+    volatile const uint8_t* product,
+    volatile uint16_t product_len,
+    struct ringbuffer* uart_out)
 {
     uint8_t payload[64] = {0};
     payload[0] = CTRL_CMD_PRODUCT_STRING;
-    memcpy(&payload[1], product, product_len);
+    for (int i = 0; i < product_len; i++) {
+        payload[1 + i] = product[i];
+    }
     uint8_t tmp[128];
     uint16_t tmp_len = da14531_protocol_format(
         &tmp[0], sizeof(tmp), DA14531_PROTOCOL_PACKET_TYPE_CTRL_DATA, &payload[0], 1 + product_len);

src/da14531/da14531.h

@@ -36,9 +36,12 @@ void da14531_power_down(struct ringbuffer* uart_out);
 
 void da14531_reset(struct ringbuffer* uart_out);
 
-// product is an array of characters to be set as product characteristic
+// product is an array of characters to be set as product characteristic (not null terminated)
 // procuct_len is the number of characters in the product array
 // uart_out is the queue where to put the outgoing serially encoded bytes
-void da14531_set_product(const char* product, uint16_t product_len, struct ringbuffer* uart_out);
+void da14531_set_product(
+    volatile const uint8_t* product,
+    volatile uint16_t product_len,
+    struct ringbuffer* uart_out);
 
 #endif

src/da14531/da14531_handler.c

@@ -24,6 +24,11 @@
 #include <ui/components/confirm.h>
 #include <ui/fonts/monogram_5X9.h>
 
+// These are set from interrupt context in the orientation workflow :/ therefore they need to be
+// volatile
+volatile const uint8_t* da14531_handler_current_product = NULL;
+volatile uint16_t da14531_handler_current_product_len = 0;
+
 struct da14531_ctrl_frame {
     enum da14531_protocol_packet_type type;
     uint16_t payload_length; // includes length of cmd
@@ -212,12 +217,8 @@ static void _ctrl_handler(struct da14531_ctrl_frame* frame, struct ringbuffer* q
     } break;
     case CTRL_CMD_PRODUCT_STRING: {
         // util_log("da14531: get device mode");
-#if defined(BOOTLOADER)
-#define DEVICE_MODE "{\"p\":\"bb02p-bl-multi\",\"v\":\"1.1.0\"}"
-#else
-#define DEVICE_MODE "{\"p\":\"bb02p-multi\",\"v\":\"9.22.0\"}"
-#endif
-        da14531_set_product(DEVICE_MODE, sizeof(DEVICE_MODE) - 1, queue);
+        da14531_set_product(
+            da14531_handler_current_product, da14531_handler_current_product_len, queue);
     } break;
     case CTRL_CMD_IDENTITY_ADDRESS: {
         // util_log("da14531: get addr");

src/da14531/da14531_handler.h

@@ -18,6 +18,9 @@
 #include "da14531_protocol.h"
 #include <utils_ringbuffer.h>
 
+extern volatile const uint8_t* da14531_handler_current_product;
+extern volatile uint16_t da14531_handler_current_product_len;
+
 void da14531_handler(struct da14531_protocol_frame* frame, struct ringbuffer* queue);
 
 #endif

src/da14531/da14531_protocol.c

@@ -242,7 +242,12 @@ static struct da14531_protocol_frame* _serial_link_in_poll(
     case SERIAL_LINK_STATE_READING: {
         int len = self->buf_in_len;
         for (int i = 0; i < len; i++) {
-            // util_log("i:%d,b:%02x,l:%u", i, self->buf_in[i], self->buf_in_len);
+            // util_log(
+            //     "i:%d,b:%02x,l:%u,h:%s",
+            //     i,
+            //     self->buf_in[i],
+            //     self->buf_in_len,
+            //     util_dbg_hex(&self->frame[0], 10));
             self->buf_in_len--;
             // Reset firmware loader on STX
             if (self->buf_in[i] == STX) {

src/firmware_main_loop.c

@@ -47,21 +47,17 @@
 
 void firmware_main_loop(void)
 {
-    // This starts the async orientation screen workflow, which is processed by the loop below.
-    orientation_screen();
-
-    // TODO: Send out new BLE product string, so app sees that we are booted
-    // Set it to the size of the ringbuffer in the UART driver so we can read out all bytes
+    // Set the size of uart_read_buf to the size of the ringbuffer in the UART driver so we can read
+    // out all bytes
     uint8_t uart_read_buf[USART_0_BUFFER_SIZE] = {0};
     uint16_t uart_read_buf_len = 0;
 
     struct ringbuffer uart_write_queue;
     uint8_t uart_write_buf[UART_OUT_BUF_LEN];
     ringbuffer_init(&uart_write_queue, &uart_write_buf, UART_OUT_BUF_LEN);
 
-// Immediately enqueue the new firmware product string
-#define DEVICE_MODE "{\"p\":\"bb02p-multi\",\"v\":\"9.22.0\"}"
-    da14531_set_product(DEVICE_MODE, sizeof(DEVICE_MODE) - 1, &uart_write_queue);
+    // This starts the async orientation screen workflow, which is processed by the loop below.
+    orientation_screen(&uart_write_queue);
 
     const uint8_t* hww_data = NULL;
     uint8_t hww_frame[USB_REPORT_SIZE] = {0};

src/system.c

@@ -28,7 +28,7 @@ static void _ble_clear_product(void)
     struct ringbuffer uart_queue;
     uint8_t uart_queue_buf[64];
     ringbuffer_init(&uart_queue, &uart_queue_buf[0], sizeof(uart_queue_buf));
-    da14531_set_product("", 0, &uart_queue);
+    da14531_set_product(NULL, 0, &uart_queue);
     while (ringbuffer_num(&uart_queue)) {
 #ifndef TESTING
         uart_poll(NULL, 0, NULL, &uart_queue);

src/usb/usb.c

@@ -19,6 +19,8 @@
 #include "usb_desc_bitbox02plus.h"
 #include "usb_size.h"
 #include "usbdc.h"
+#include <da14531/da14531.h>
+#include <da14531/da14531_handler.h>
 #include <memory/memory_shared.h>
 #if APP_U2F == 1
 #include "u2f.h"
@@ -46,7 +48,6 @@ static uint8_t _descriptor_bytes_bitbox02plus[] = {
 static struct usbd_descriptors _descriptor_bitbox02plus[] = {
     {_descriptor_bytes_bitbox02plus,
      _descriptor_bytes_bitbox02plus + sizeof(_descriptor_bytes_bitbox02plus)}};
-static void (*_on_hww_init)(void) = NULL;
 static void _hww_endpoint_available(void);
 #if APP_U2F == 1
 static void _u2f_endpoint_available(void);
@@ -58,9 +59,6 @@ static void _hww_endpoint_available(void)
     if (!hid_hww_is_enabled()) {
         return;
     }
-    if (_on_hww_init != NULL) {
-        _on_hww_init();
-    }
     hid_hww_setup();
 }
 
@@ -71,7 +69,6 @@ static void _u2f_endpoint_available(void)
     if (!hid_u2f_is_enabled()) {
         return;
     };
-    u2f_device_setup();
     hid_u2f_setup();
 }
 #endif
@@ -87,7 +84,7 @@ static void _timeout_cb(const struct timer_task* const timer_task)
 
 static bool _usb_enabled = false;
 
-int32_t usb_start(void (*on_hww_init)(void))
+int32_t usb_start(void)
 {
 #if !defined(TESTING) && APP_U2F == 1
     static struct timer_task Timer_task;
@@ -105,7 +102,6 @@ int32_t usb_start(void (*on_hww_init)(void))
     if (ret != 0) {
         return ret;
     }
-    _on_hww_init = on_hww_init;
     ret = hid_hww_init(_hww_endpoint_available);
     if (ret != 0) {
         return ret;
@@ -125,8 +121,6 @@ int32_t usb_start(void (*on_hww_init)(void))
         break;
     }
     usbdc_attach();
-#else
-    (void)on_hww_init;
 #endif
     _usb_enabled = true;
     return 0;