usb_selftest_wlun_host.c

Go to the documentation of this file.

 
#include <stdint.h>
#include <string.h>
 
#include "ra8_board_ek_ra8d2.h"
#include "ra8_err.h"
#include "ra8_usb_hmsc.h"
#include "tx_api.h"
#include "usb_selftest_wlun_steps.h"
 
#ifndef RA8_OFF_TARGET
 
/* -------------------------------------------------------------------------- */
/* J-Link probes (host ladder) */
/* -------------------------------------------------------------------------- */

static volatile uint32_t s_dbg_phase;
static volatile uint32_t s_dbg_luns_ok;
static volatile uint32_t s_dbg_max_lun;
static volatile uint32_t s_dbg_mismatch = (uint32_t)k_wlun_no_mismatch;
static volatile uint32_t s_dbg_pass_count;
 
/* -------------------------------------------------------------------------- */
/* Host side: ra8_usb_hmsc enumerate + WRITE(10) then read-verify */
/* -------------------------------------------------------------------------- */

[[nodiscard]] static ra8_err_t wlun_write_disk(uint32_t lun)
{
  static uint8_t s_wbuf[k_wlun_burst_bytes] = {};
  for (uint32_t blk = 0U; blk < (uint32_t)k_wlun_sectors; blk += (uint32_t)k_wlun_burst_blocks) {
    for (uint32_t s = 0U; s < (uint32_t)k_wlun_burst_blocks; s++) {
      wlun_pattern_fill(lun, blk + s, &s_wbuf[s * (uint32_t)k_wlun_block_size]);
    }
    const ra8_err_t err =
      ra8_usb_hmsc_write10((uint8_t)lun, blk, (uint16_t)k_wlun_burst_blocks, s_wbuf);
    if (err != k_ra8_ok) {
      (void)wlun_print_fail("WRITE(10)", err);
      return err;
    }
  }
  return k_ra8_ok;
}

[[nodiscard]] static ra8_err_t wlun_verify_one(uint32_t lun)
{
  static uint8_t s_burst[k_wlun_burst_bytes] = {};
  static uint8_t s_expect[k_wlun_block_size] = {};
 
  uint32_t  block_count = 0U;
  uint32_t  block_size  = 0U;
  ra8_err_t err         = ra8_usb_hmsc_read_capacity((uint8_t)lun, &block_count, &block_size);
  if (err != k_ra8_ok) {
    (void)wlun_print_fail("read_capacity", err);
    return err;
  }
  if (block_count != (uint32_t)k_wlun_sectors) {
    (void)wlun_print_fail("capacity mismatch", k_ra8_err_invalid_size);
    return k_ra8_err_invalid_size;
  }
  for (uint32_t blk = 0U; blk < (uint32_t)k_wlun_sectors; blk += (uint32_t)k_wlun_burst_blocks) {
    err = ra8_usb_hmsc_read10((uint8_t)lun, blk, (uint16_t)k_wlun_burst_blocks, s_burst);
    if (err != k_ra8_ok) {
      (void)wlun_print_fail("READ(10)", err);
      return err;
    }
    for (uint32_t s = 0U; s < (uint32_t)k_wlun_burst_blocks; s++) {
      wlun_pattern_fill(lun, blk + s, s_expect);
      const uint32_t boff = s * (uint32_t)k_wlun_block_size;
      if (memcmp(&s_burst[boff], s_expect, (size_t)k_wlun_block_size) != 0) {
        s_dbg_mismatch = (lun << (uint32_t)k_wlun_mismatch_lun_shift) | (blk + s);
        (void)wlun_print_fail("LUN data mismatch", k_ra8_err_invalid_state);
        return k_ra8_err_invalid_state;
      }
    }
  }
  return k_ra8_ok;
}

[[nodiscard]] static ra8_err_t wlun_print_lun_ok(uint32_t lun)
{
  ra8_err_t err = wlun_print("ra8d2 wlun: LUN ");
  if (err != k_ra8_ok) {
    return err;
  }
  err = wlun_print_dec(lun);
  if (err != k_ra8_ok) {
    return err;
  }
  return wlun_print(" OK (64 sectors, write+read verified)\r\n");
}

[[nodiscard]] static ra8_err_t wlun_host_enumerate(ra8_usb_hmsc_device_t* device)
{
  s_dbg_phase   = (uint32_t)k_wlun_phase_enum;
  ra8_err_t err = ra8_usb_hmsc_enumerate(device);
  if (err != k_ra8_ok) {
    (void)wlun_print_fail("enumerate", err);
    (void)ra8_usb_hmsc_close();
    return err;
  }
  s_dbg_max_lun = (uint32_t)device->max_lun;
  err           = wlun_print("ra8d2 wlun: enumerated pid=0x");
  if (err != k_ra8_ok) {
    return err;
  }
  err = wlun_print_hex((uint32_t)device->product_id, (uint8_t)k_wlun_hex_chars_u16);
  if (err != k_ra8_ok) {
    return err;
  }
  err = wlun_print(", GET_MAX_LUN=");
  if (err != k_ra8_ok) {
    return err;
  }
  err = wlun_print_dec(s_dbg_max_lun);
  if (err != k_ra8_ok) {
    return err;
  }
  return wlun_print("\r\n");
}

[[nodiscard]] static ra8_err_t wlun_host_pass(void)
{
  s_dbg_phase   = (uint32_t)k_wlun_phase_init;
  ra8_err_t err = wlun_print("ra8d2 wlun: host up on USB-HS, probing the loop...\r\n");
  if (err != k_ra8_ok) {
    return err;
  }
  err = ra8_usb_hmsc_init(k_ra8_usb_speed_hs);
  if (err != k_ra8_ok) {
    (void)wlun_print_fail("host init", err);
    return err;
  }
 
  ra8_usb_hmsc_device_t device = {};
  err                          = wlun_host_enumerate(&device);
  if (err != k_ra8_ok) {
    return err;
  }
 
  s_dbg_phase   = (uint32_t)k_wlun_phase_verify;
  s_dbg_luns_ok = 0U;
  for (uint32_t lun = 0U; lun < (uint32_t)k_wlun_count; lun++) {
    err = wlun_write_disk(lun);
    if (err != k_ra8_ok) {
      (void)ra8_usb_hmsc_close();
      return err;
    }
    err = wlun_verify_one(lun);
    if (err != k_ra8_ok) {
      (void)ra8_usb_hmsc_close();
      return err;
    }
    s_dbg_luns_ok++;
    err = wlun_print_lun_ok(lun);
    if (err != k_ra8_ok) {
      return err;
    }
  }
 
  s_dbg_phase = (uint32_t)k_wlun_phase_pass;
  s_dbg_pass_count++;
  err = wlun_print("ra8d2 wlun: USB SELFTEST WRITABLE-LUN PASS\r\n");
  if (err != k_ra8_ok) {
    return err;
  }
  (void)ra8_board_led_on(k_ra8_board_led2);
  return k_ra8_ok;
}
 
VOID wlun_host_worker(ULONG arg)
{
  (void)arg;
 
  tx_thread_sleep(k_wlun_boot_wait_ticks);
  for (;;) {
    const ra8_err_t err = wlun_host_pass();
    if (err == k_ra8_ok) {
      break;
    }
    tx_thread_sleep(k_wlun_retry_ticks);
  }
  while (1) {
    tx_thread_sleep(k_wlun_idle_ticks);
  }
}
 
#endif /* !RA8_OFF_TARGET */