From 1aa6b92bc468138cce71764e3ca9fcddf6e63cf8 Mon Sep 17 00:00:00 2001 From: TuxSH Date: Sun, 6 May 2018 15:02:13 +0200 Subject: [PATCH] Normalize drivers between stage1 and 2 --- fusee/fusee-primary/src/lib/driver_utils.h | 7 ++++ fusee/fusee-primary/src/sdmmc.c | 38 ++++++++++---------- fusee/fusee-primary/src/supplies.c | 2 +- fusee/fusee-secondary/src/lib/driver_utils.h | 10 ++++++ fusee/fusee-secondary/src/sdmmc.c | 15 ++++---- fusee/fusee-secondary/src/supplies.c | 4 +-- 6 files changed, 46 insertions(+), 30 deletions(-) create mode 100644 fusee/fusee-primary/src/lib/driver_utils.h create mode 100644 fusee/fusee-secondary/src/lib/driver_utils.h diff --git a/fusee/fusee-primary/src/lib/driver_utils.h b/fusee/fusee-primary/src/lib/driver_utils.h new file mode 100644 index 000000000..b33df1686 --- /dev/null +++ b/fusee/fusee-primary/src/lib/driver_utils.h @@ -0,0 +1,7 @@ +#ifndef FUSEE_DRIVER_UTILS_H +#define FUSEE_DRIVER_UTILS_H + +#include "vsprintf.h" +#include "printk.h" + +#endif diff --git a/fusee/fusee-primary/src/sdmmc.c b/fusee/fusee-primary/src/sdmmc.c index 8538bf996..5de5b3136 100644 --- a/fusee/fusee-primary/src/sdmmc.c +++ b/fusee/fusee-primary/src/sdmmc.c @@ -1,12 +1,13 @@ /** * Fusée SD/MMC driver for the Switch - * ~ktemkin + * ~ktemkin */ #include #include #include +#include "lib/driver_utils.h" #include "sdmmc.h" #include "car.h" #include "pinmux.h" @@ -16,7 +17,6 @@ #include "supplies.h" #include "pmc.h" #include "pad_control.h" -#include "lib/printk.h" #define TEGRA_SDMMC_BASE (0x700B0000) #define TEGRA_SDMMC_SIZE (0x200) @@ -233,7 +233,7 @@ enum sdmmc_command { CMD_SEND_EXT_CSD = 8, CMD_SEND_IF_COND = 8, CMD_SEND_CSD = 9, - CMD_SEND_CID = 10, + CMD_SEND_CID = 10, CMD_STOP_TRANSMISSION = 12, CMD_READ_STATUS = 13, CMD_BUS_TEST = 14, @@ -315,7 +315,7 @@ enum sdmmc_csd_versions { -/** +/** * Positions of different fields in various CSDs. * May eventually be replaced with a bitfield struct, if we use enough of the CSDs. */ @@ -764,20 +764,20 @@ static int sdmmc_hardware_init(struct mmc *mmc) // Clear PAD_E_INPUT_OR_E_PWRD (relevant for eMMC only) regs->sdmemcomppadctrl &= ~(0x80000000); - + // Set SDHCI_CLOCK_INT_EN regs->clock_control |= 0x01; - + // Program a timeout of 2000ms timebase = get_time(); is_timeout = false; - + // Wait for SDHCI_CLOCK_INT_STABLE to be set while (!(regs->clock_control & 0x02) && !is_timeout) { // Keep checking if timeout expired is_timeout = get_time_since(timebase) > 2000000; } - + // Clock failed to stabilize if (is_timeout) { mmc_print(mmc, "clock never stabalized!"); @@ -814,7 +814,7 @@ static int sdmmc_hardware_init(struct mmc *mmc) // Clear SDHCI_CTRL_HISPD regs->host_control &= 0xFB; - // Clear SDHCI_CTRL_VDD_180 + // Clear SDHCI_CTRL_VDD_180 regs->host_control2 &= ~(0x08); // Set SDHCI_DIVIDER and SDHCI_DIVIDER_HI @@ -919,7 +919,7 @@ static int sdmmc_wait_until_no_longer_busy(struct mmc *mmc) * Blocks until the SD driver has completed issuing a command. * * @param mmc The MMC controller on which to wait. - * @param target_irq A bitmask that specifies the bits that + * @param target_irq A bitmask that specifies the bits that * will make this function return success * @param fault_conditions A bitmask that specifies the bits that * will make this function return EFAULT. @@ -927,7 +927,7 @@ static int sdmmc_wait_until_no_longer_busy(struct mmc *mmc) * @return 0 on sucess, EFAULT if a fault condition occurs, * or an error code if a transfer failure occurs */ -static int sdmmc_wait_for_interrupt(struct mmc *mmc, +static int sdmmc_wait_for_interrupt(struct mmc *mmc, uint32_t target_irq, uint32_t fault_conditions) { uint32_t timebase = get_time(); @@ -1066,7 +1066,7 @@ static int sdmmc_handle_cpu_transfer(struct mmc *mmc, uint16_t blocks, bool is_w * @param auto_termiante True iff we should instruct the system * to reclaim the data lines after a transaction. */ -static void sdmmc_prepare_command_data(struct mmc *mmc, uint16_t blocks, +static void sdmmc_prepare_command_data(struct mmc *mmc, uint16_t blocks, bool is_write, bool auto_terminate, int argument) { if (blocks) { @@ -1122,7 +1122,7 @@ static void sdmmc_prepare_command_data(struct mmc *mmc, uint16_t blocks, static void sdmmc_prepare_command_registers(struct mmc *mmc, int blocks_to_xfer, enum sdmmc_command command, enum sdmmc_response_type response_type, enum sdmmc_response_checks checks) { - // Populate the command number + // Populate the command number uint16_t to_write = (command << MMC_COMMAND_NUMBER_SHIFT) | (response_type << MMC_COMMAND_RESPONSE_TYPE_SHIFT) | checks; // If this is a "stop transmitting" command, set the abort flag. @@ -1234,7 +1234,7 @@ static int sdmmc_handle_command_response(struct mmc *mmc, * @param blocks_to_transfer The number of SDMMC blocks to be transferred with the given command, * or 0 to indicate that this command should not expect response data. * @param is_write True iff the given command issues data _to_ the card, instead of vice versa. - * @param auto_terminate True iff the gven command needs to be terminated with e.g. CMD12 + * @param auto_terminate True iff the gven command needs to be terminated with e.g. CMD12 * @param data_buffer A byte buffer that either contains the data to be sent, or which should * receive data, depending on the is_write argument. * @@ -1242,7 +1242,7 @@ static int sdmmc_handle_command_response(struct mmc *mmc, */ static int sdmmc_send_command(struct mmc *mmc, enum sdmmc_command command, enum sdmmc_response_type response_type, enum sdmmc_response_checks checks, - uint32_t argument, void *response_buffer, uint16_t blocks_to_transfer, + uint32_t argument, void *response_buffer, uint16_t blocks_to_transfer, bool is_write, bool auto_terminate, void *data_buffer) { uint32_t total_data_to_xfer = sdmmc_get_block_size(mmc, is_write) * blocks_to_transfer; @@ -1525,7 +1525,7 @@ static int sdmmc_read_and_parse_ext_csd(struct mmc *mmc) uint8_t ext_csd[MMC_EXT_CSD_SIZE]; // Read the single EXT CSD block. - rc = sdmmc_send_command(mmc, CMD_SEND_EXT_CSD, MMC_RESPONSE_LEN48, + rc = sdmmc_send_command(mmc, CMD_SEND_EXT_CSD, MMC_RESPONSE_LEN48, MMC_CHECKS_ALL, 0, NULL, 1, false, false, ext_csd); if (rc) { mmc_print(mmc, "ERROR: failed to read the extended CSD!"); @@ -1762,7 +1762,7 @@ static int sdmmc_mmc_wait_for_card_readiness(struct mmc *mmc) uint32_t response_masked; // Ask the SD card to identify its state. It will respond with readiness and a capacity magic. - rc = sdmmc_send_command(mmc, CMD_SEND_OPERATING_CONDITIONS, MMC_RESPONSE_LEN48, + rc = sdmmc_send_command(mmc, CMD_SEND_OPERATING_CONDITIONS, MMC_RESPONSE_LEN48, MMC_CHECKS_NONE, 0x40000080, response, 0, false, false, NULL); if (rc) { mmc_print(mmc, "ERROR: could not read the card's operating conditions!"); @@ -2018,7 +2018,7 @@ static int sdmmc_wait_for_card_ready(struct mmc *mmc, uint32_t timeout) static int sdmmc_mmc_switch_mode(struct mmc *mmc, enum sdmmc_switch_access_mode mode, enum sdmmc_switch_field field, uint16_t value, uint32_t timeout) { // Collapse our various parameters into a single argument. - uint32_t argument = + uint32_t argument = (mode << MMC_SWITCH_ACCESS_MODE_SHIFT) | (field << MMC_SWITCH_FIELD_SHIFT) | (value << MMC_SWITCH_VALUE_SHIFT); @@ -2088,7 +2088,7 @@ bool sdmmc_external_card_present(struct mmc *mmc) } /** - * Switches a given SDMMC Controller where + * Switches a given SDMMC Controller where */ static void sdmmc_apply_card_type(struct mmc *mmc, enum sdmmc_card_type type) { diff --git a/fusee/fusee-primary/src/supplies.c b/fusee/fusee-primary/src/supplies.c index 821267f44..ebaf9d518 100644 --- a/fusee/fusee-primary/src/supplies.c +++ b/fusee/fusee-primary/src/supplies.c @@ -3,8 +3,8 @@ * ~ktemkin */ +#include "lib/driver_utils.h" #include "supplies.h" -#include "lib/printk.h" // FIXME: replace hwinit with our own code #include "hwinit/max7762x.h" diff --git a/fusee/fusee-secondary/src/lib/driver_utils.h b/fusee/fusee-secondary/src/lib/driver_utils.h new file mode 100644 index 000000000..8f0a22e66 --- /dev/null +++ b/fusee/fusee-secondary/src/lib/driver_utils.h @@ -0,0 +1,10 @@ +#ifndef FUSEE_DRIVER_UTILS_H +#define FUSEE_DRIVER_UTILS_H + +#include +#include + +#define vprintk vprintf +#define printk printf + +#endif diff --git a/fusee/fusee-secondary/src/sdmmc.c b/fusee/fusee-secondary/src/sdmmc.c index cf88a9fd0..324e45164 100644 --- a/fusee/fusee-secondary/src/sdmmc.c +++ b/fusee/fusee-secondary/src/sdmmc.c @@ -2,12 +2,11 @@ * Fusée SD/MMC driver for the Switch * ~ktemkin */ -#include -#include #include #include #include +#include "lib/driver_utils.h" #include "sdmmc.h" #include "car.h" #include "pinmux.h" @@ -427,9 +426,9 @@ static void mmc_vprint(struct mmc *mmc, char *fmt, int required_loglevel, va_lis if (sdmmc_loglevel < required_loglevel) return; - printf("%s: ", mmc->name); - vprintf(fmt, list); - printf("\n"); + printk("%s: ", mmc->name); + vprintk(fmt, list); + printk("\n"); } @@ -732,7 +731,7 @@ static int sdmmc_set_up_clocking_parameters(struct mmc *mmc) break; default: - printf("ERROR: initialization not yet writen for SDMMC%d", mmc->controller); + printk("ERROR: initialization not yet writen for SDMMC%d", mmc->controller); return ENODEV; } @@ -1480,7 +1479,7 @@ static uint32_t sdmmc_extract_csd_bits(uint32_t *csd, int start, int width) // Sanity check our span. if ((start + width) > 128) { - printf("MMC ERROR: invalid CSD slice!\n"); + printk("MMC ERROR: invalid CSD slice!\n"); return 0xFFFFFFFF; } @@ -2205,7 +2204,7 @@ static void sdmmc_initialize_defaults(struct mmc *mmc) break; default: - printf("ERROR: initialization not yet writen for SDMMC%d", mmc->controller); + printk("ERROR: initialization not yet writen for SDMMC%d", mmc->controller); break; } } diff --git a/fusee/fusee-secondary/src/supplies.c b/fusee/fusee-secondary/src/supplies.c index 6276e2256..ebaf9d518 100644 --- a/fusee/fusee-secondary/src/supplies.c +++ b/fusee/fusee-secondary/src/supplies.c @@ -3,7 +3,7 @@ * ~ktemkin */ -#include +#include "lib/driver_utils.h" #include "supplies.h" // FIXME: replace hwinit with our own code @@ -23,7 +23,7 @@ void supply_enable(enum switch_power_supply supply) return; default: - printf("ERROR: could not enable unknown supply %d!\n", supply); + printk("ERROR: could not enable unknown supply %d!\n", supply); return; } }