msc init
This commit is contained in:
shanggl
Hugo Chiang
parent
7151f86e73
commit
4ac706740b
|
|
@ -0,0 +1,263 @@
|
|||
/*
|
||||
* This file is part of Cleanflight and Betaflight.
|
||||
*
|
||||
* Cleanflight and Betaflight are free software. You can redistribute
|
||||
* this software and/or modify this software under the terms of the
|
||||
* GNU General Public License as published by the Free Software
|
||||
* Foundation, either version 3 of the License, or (at your option)
|
||||
* any later version.
|
||||
*
|
||||
* Cleanflight and Betaflight are distributed in the hope that they
|
||||
* will be useful, but WITHOUT ANY WARRANTY; without even the implied
|
||||
* warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
|
||||
* See the GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this software.
|
||||
*
|
||||
* If not, see <http://www.gnu.org/licenses/>.
|
||||
*/
|
||||
|
||||
/*
|
||||
* Author: Chris Hockuba (https://github.com/conkerkh)
|
||||
*
|
||||
*/
|
||||
|
||||
#include <stdint.h>
|
||||
#include <stdbool.h>
|
||||
#include <string.h>
|
||||
|
||||
#include "platform.h"
|
||||
|
||||
#if defined(USE_USB_MSC)
|
||||
|
||||
#include "build/build_config.h"
|
||||
|
||||
#include "common/utils.h"
|
||||
|
||||
#include "blackbox/blackbox.h"
|
||||
|
||||
#include "drivers/io.h"
|
||||
#include "drivers/nvic.h"
|
||||
#include "drivers/sdmmc_sdio.h"
|
||||
#include "drivers/system.h"
|
||||
#include "drivers/time.h"
|
||||
#include "drivers/usb_msc.h"
|
||||
|
||||
|
||||
#include "pg/sdcard.h"
|
||||
#include "pg/usb.h"
|
||||
|
||||
#include "usb_conf.h"
|
||||
#include "usb_core.h"
|
||||
#include "usbd_int.h"
|
||||
#include "msc_class.h"
|
||||
#include "msc_desc.h"
|
||||
|
||||
#include "usb_io.h"
|
||||
|
||||
extern otg_core_type otg_core_struct;
|
||||
|
||||
|
||||
/**
|
||||
* @brief this function config gpio.
|
||||
* @param none
|
||||
* @retval none
|
||||
*/
|
||||
void msc_usb_gpio_config(void)
|
||||
{
|
||||
gpio_init_type gpio_init_struct;
|
||||
|
||||
crm_periph_clock_enable(OTG_PIN_GPIO_CLOCK, TRUE);
|
||||
gpio_default_para_init(&gpio_init_struct);
|
||||
|
||||
gpio_init_struct.gpio_drive_strength = GPIO_DRIVE_STRENGTH_STRONGER;
|
||||
gpio_init_struct.gpio_out_type = GPIO_OUTPUT_PUSH_PULL;
|
||||
gpio_init_struct.gpio_mode = GPIO_MODE_MUX;
|
||||
gpio_init_struct.gpio_pull = GPIO_PULL_NONE;
|
||||
|
||||
/* dp and dm */
|
||||
gpio_init_struct.gpio_pins = OTG_PIN_DP | OTG_PIN_DM;
|
||||
gpio_init(OTG_PIN_GPIO, &gpio_init_struct);
|
||||
|
||||
gpio_pin_mux_config(OTG_PIN_GPIO, OTG_PIN_DP_SOURCE, OTG_PIN_MUX);
|
||||
gpio_pin_mux_config(OTG_PIN_GPIO, OTG_PIN_DM_SOURCE, OTG_PIN_MUX);
|
||||
|
||||
#ifdef USB_SOF_OUTPUT_ENABLE
|
||||
crm_periph_clock_enable(OTG_PIN_SOF_GPIO_CLOCK, TRUE);
|
||||
gpio_init_struct.gpio_pins = OTG_PIN_SOF;
|
||||
gpio_init(OTG_PIN_SOF_GPIO, &gpio_init_struct);
|
||||
gpio_pin_mux_config(OTG_PIN_GPIO, OTG_PIN_SOF_SOURCE, OTG_PIN_MUX);
|
||||
#endif
|
||||
|
||||
/* otgfs use vbus pin */
|
||||
#ifndef USB_VBUS_IGNORE
|
||||
gpio_init_struct.gpio_pins = OTG_PIN_VBUS;
|
||||
gpio_init_struct.gpio_pull = GPIO_PULL_DOWN;
|
||||
gpio_pin_mux_config(OTG_PIN_GPIO, OTG_PIN_VBUS_SOURCE, OTG_PIN_MUX);
|
||||
gpio_init(OTG_PIN_GPIO, &gpio_init_struct);
|
||||
#endif
|
||||
|
||||
|
||||
}
|
||||
|
||||
/**
|
||||
* @brief usb 48M clock select
|
||||
* @param clk_s:USB_CLK_HICK, USB_CLK_HEXT
|
||||
* @retval none
|
||||
*/
|
||||
void msc_usb_clock48m_select(usb_clk48_s clk_s)
|
||||
{
|
||||
if(clk_s == USB_CLK_HICK)
|
||||
{
|
||||
crm_usb_clock_source_select(CRM_USB_CLOCK_SOURCE_HICK);
|
||||
|
||||
/* enable the acc calibration ready interrupt */
|
||||
crm_periph_clock_enable(CRM_ACC_PERIPH_CLOCK, TRUE);
|
||||
|
||||
/* update the c1\c2\c3 value */
|
||||
acc_write_c1(7980);
|
||||
acc_write_c2(8000);
|
||||
acc_write_c3(8020);
|
||||
#if (USB_ID == 0)
|
||||
acc_sof_select(ACC_SOF_OTG1);
|
||||
#else
|
||||
acc_sof_select(ACC_SOF_OTG2);
|
||||
#endif
|
||||
/* open acc calibration */
|
||||
acc_calibration_mode_enable(ACC_CAL_HICKTRIM, TRUE);
|
||||
}
|
||||
else
|
||||
{
|
||||
switch(system_core_clock)
|
||||
{
|
||||
/* 48MHz */
|
||||
case 48000000:
|
||||
crm_usb_clock_div_set(CRM_USB_DIV_1);
|
||||
break;
|
||||
|
||||
/* 72MHz */
|
||||
case 72000000:
|
||||
crm_usb_clock_div_set(CRM_USB_DIV_1_5);
|
||||
break;
|
||||
|
||||
/* 96MHz */
|
||||
case 96000000:
|
||||
crm_usb_clock_div_set(CRM_USB_DIV_2);
|
||||
break;
|
||||
|
||||
/* 120MHz */
|
||||
case 120000000:
|
||||
crm_usb_clock_div_set(CRM_USB_DIV_2_5);
|
||||
break;
|
||||
|
||||
/* 144MHz */
|
||||
case 144000000:
|
||||
crm_usb_clock_div_set(CRM_USB_DIV_3);
|
||||
break;
|
||||
|
||||
/* 168MHz */
|
||||
case 168000000:
|
||||
crm_usb_clock_div_set(CRM_USB_DIV_3_5);
|
||||
break;
|
||||
|
||||
/* 192MHz */
|
||||
case 192000000:
|
||||
crm_usb_clock_div_set(CRM_USB_DIV_4);
|
||||
break;
|
||||
|
||||
/* 216MHz */
|
||||
case 216000000:
|
||||
crm_usb_clock_div_set(CRM_USB_DIV_4_5);
|
||||
break;
|
||||
|
||||
/* 240MHz */
|
||||
case 240000000:
|
||||
crm_usb_clock_div_set(CRM_USB_DIV_5);
|
||||
break;
|
||||
|
||||
/* 264MHz */
|
||||
case 264000000:
|
||||
crm_usb_clock_div_set(CRM_USB_DIV_5_5);
|
||||
break;
|
||||
|
||||
/* 288MHz */
|
||||
case 288000000:
|
||||
crm_usb_clock_div_set(CRM_USB_DIV_6);
|
||||
break;
|
||||
|
||||
default:
|
||||
break;
|
||||
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
uint8_t mscStart(void)
|
||||
{
|
||||
//Start USB
|
||||
usbGenerateDisconnectPulse();
|
||||
|
||||
IOInit(IOGetByTag(IO_TAG(PA11)), OWNER_USB, 0);
|
||||
IOInit(IOGetByTag(IO_TAG(PA12)), OWNER_USB, 0);
|
||||
|
||||
// switch (blackboxConfig()->device) {
|
||||
//#ifdef USE_SDCARD
|
||||
// case BLACKBOX_DEVICE_SDCARD:
|
||||
// switch (sdcardConfig()->mode) {
|
||||
//#ifdef USE_SDCARD_SDIO
|
||||
// case SDCARD_MODE_SDIO:
|
||||
// USBD_STORAGE_fops = &USBD_MSC_MICRO_SDIO_fops;
|
||||
// break;
|
||||
//#endif
|
||||
//#ifdef USE_SDCARD_SPI
|
||||
// case SDCARD_MODE_SPI:
|
||||
// USBD_STORAGE_fops = &USBD_MSC_MICRO_SD_SPI_fops;
|
||||
// break;
|
||||
//#endif
|
||||
// default:
|
||||
// return 1;
|
||||
// }
|
||||
// break;
|
||||
//#endif
|
||||
//
|
||||
//#ifdef USE_FLASHFS
|
||||
// case BLACKBOX_DEVICE_FLASH:
|
||||
// USBD_STORAGE_fops = &USBD_MSC_EMFAT_fops;
|
||||
// break;
|
||||
//#endif
|
||||
// default:
|
||||
// return 1;
|
||||
// }
|
||||
|
||||
// USBD_Init(&USB_OTG_dev, USB_OTG_FS_CORE_ID, &MSC_desc, &USBD_MSC_cb, &USR_cb);
|
||||
/* init usb */
|
||||
/* usb gpio config */
|
||||
msc_usb_gpio_config();
|
||||
|
||||
/* enable otgfs clock */
|
||||
crm_periph_clock_enable(OTG_CLOCK, TRUE);
|
||||
|
||||
/* select usb 48m clcok source */
|
||||
msc_usb_clock48m_select(USB_CLK_HEXT);
|
||||
|
||||
/* enable otgfs irq */
|
||||
nvic_irq_enable(OTG_IRQ, 0, 0);
|
||||
|
||||
usbd_init(&otg_core_struct,
|
||||
USB_FULL_SPEED_CORE_ID,
|
||||
USB_ID,
|
||||
&msc_class_handler,
|
||||
&msc_desc_handler);
|
||||
|
||||
// NVIC configuration for SYSTick
|
||||
nvic_irq_disable(SysTick_IRQn);
|
||||
|
||||
nvic_irq_enable(SysTick_IRQn, 0, 0);
|
||||
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
#endif
|
||||
|
|
@ -0,0 +1,100 @@
|
|||
/*
|
||||
* At32 MSC scsi interface
|
||||
* 先实现FLASH emfat 方式读写，后面再实现sd等其他存储读写
|
||||
*
|
||||
*
|
||||
*
|
||||
*
|
||||
*/
|
||||
|
||||
|
||||
#include <stdbool.h>
|
||||
|
||||
#include "at32_msc_diskio.h"
|
||||
#include "platform.h"
|
||||
|
||||
#include "common/utils.h"
|
||||
|
||||
#include "drivers/light_led.h"
|
||||
#include "drivers/usb_msc.h"
|
||||
#include "msc_bot_scsi.h"
|
||||
|
||||
|
||||
|
||||
#define STORAGE_LUN_NBR 1
|
||||
|
||||
static const uint8_t scsi_inquiry[MSC_SUPPORT_MAX_LUN][SCSI_INQUIRY_DATA_LENGTH] =
|
||||
{
|
||||
/* lun = 0 */
|
||||
{
|
||||
0x00, /* peripheral device type (direct-access device) */
|
||||
0x80, /* removable media bit */
|
||||
0x00, /* ansi version, ecma version, iso version */
|
||||
0x01, /* respond data format */
|
||||
SCSI_INQUIRY_DATA_LENGTH - 5, /* additional length */
|
||||
0x00, 0x00, 0x00, /* reserved */
|
||||
'B', 'E', 'T', 'A', 'F', 'L', 'T', ' ', // Manufacturer : 8 bytes
|
||||
'O', 'n', 'b', 'o', 'a', 'r', 'd', ' ', // Product : 16 Bytes
|
||||
'F', 'l', 'a', 's', 'h', ' ', ' ', ' ', //
|
||||
' ', ' ', ' ' ,' ', // Version : 4 Bytes
|
||||
}
|
||||
};
|
||||
//
|
||||
//static const uint8_t STORAGE_Inquirydata[] =
|
||||
//{
|
||||
// 0x00, 0x80, 0x02, 0x02,
|
||||
// (SCSI_INQUIRY_DATA_LENGTH - 5),
|
||||
// 0x00, 0x00, 0x00,
|
||||
// 'B', 'E', 'T', 'A', 'F', 'L', 'T', ' ', // Manufacturer : 8 bytes
|
||||
// 'O', 'n', 'b', 'o', 'a', 'r', 'd', ' ', // Product : 16 Bytes
|
||||
// 'F', 'l', 'a', 's', 'h', ' ', ' ', ' ', //
|
||||
// ' ', ' ', ' ' ,' ', // Version : 4 Bytes
|
||||
//};
|
||||
|
||||
usb_sts_type msc_disk_capacity(uint8_t lun, uint32_t *block_num, uint32_t *block_size)
|
||||
{
|
||||
UNUSED(lun);
|
||||
*block_size = 512;
|
||||
*block_num = emfat.disk_sectors;
|
||||
return USB_OK;
|
||||
}
|
||||
|
||||
|
||||
usb_sts_type msc_disk_read(
|
||||
uint8_t lun, // logical unit number
|
||||
uint32_t blk_addr, // address of 1st block to be read
|
||||
uint8_t *buf, // Pointer to the buffer to save data
|
||||
uint32_t blk_len) // nmber of blocks to be read
|
||||
{
|
||||
UNUSED(lun);
|
||||
mscSetActive();
|
||||
emfat_read(&emfat, buf, blk_addr, blk_len);
|
||||
return USB_OK;
|
||||
}
|
||||
|
||||
usb_sts_type msc_disk_write(uint8_t lun,
|
||||
uint32_t blk_addr,
|
||||
uint8_t *buf,
|
||||
uint32_t blk_len)
|
||||
{
|
||||
UNUSED(lun);
|
||||
UNUSED(buf);
|
||||
UNUSED(blk_addr);
|
||||
UNUSED(blk_len);
|
||||
|
||||
return USB_FAIL;
|
||||
}
|
||||
|
||||
|
||||
/**
|
||||
* @brief get disk inquiry
|
||||
* @param lun: logical units number
|
||||
* @retval inquiry string
|
||||
*/
|
||||
uint8_t * get_inquiry(uint8_t lun)
|
||||
{
|
||||
if(lun < MSC_SUPPORT_MAX_LUN)
|
||||
return (uint8_t *)scsi_inquiry[lun];
|
||||
else
|
||||
return NULL;
|
||||
}
|
||||
|
|
@ -0,0 +1,43 @@
|
|||
/*
|
||||
* This file is part of Cleanflight and Betaflight.
|
||||
*
|
||||
* Cleanflight and Betaflight are free software. You can redistribute
|
||||
* this software and/or modify this software under the terms of the
|
||||
* GNU General Public License as published by the Free Software
|
||||
* Foundation, either version 3 of the License, or (at your option)
|
||||
* any later version.
|
||||
*
|
||||
* Cleanflight and Betaflight are distributed in the hope that they
|
||||
* will be useful, but WITHOUT ANY WARRANTY; without even the implied
|
||||
* warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.
|
||||
* See the GNU General Public License for more details.
|
||||
*
|
||||
* You should have received a copy of the GNU General Public License
|
||||
* along with this software.
|
||||
*
|
||||
* If not, see <http://www.gnu.org/licenses/>.
|
||||
*
|
||||
* Author: jflyper (https://github.com/jflyper)
|
||||
*/
|
||||
|
||||
#pragma once
|
||||
|
||||
#include "emfat.h"
|
||||
|
||||
extern emfat_t emfat;
|
||||
|
||||
|
||||
#ifdef __cplusplus
|
||||
extern "C" {
|
||||
#endif
|
||||
|
||||
|
||||
#include "usb_conf.h"
|
||||
#include "usb_std.h"
|
||||
|
||||
|
||||
|
||||
uint8_t *get_inquiry(uint8_t lun);
|
||||
usb_sts_type msc_disk_read(uint8_t lun, uint32_t addr, uint8_t *read_buf, uint32_t len);
|
||||
usb_sts_type msc_disk_write(uint8_t lun, uint32_t addr, uint8_t *buf, uint32_t len);
|
||||
usb_sts_type msc_disk_capacity(uint8_t lun, uint32_t *blk_nbr, uint32_t *blk_size);
|
||||
Loading…
Reference in New Issue