Normalize drivers between stage1 and 2

This commit is contained in:
TuxSH 2018-05-06 15:02:13 +02:00
parent 306555e522
commit 1aa6b92bc4
6 changed files with 46 additions and 30 deletions

View file

@ -0,0 +1,7 @@
#ifndef FUSEE_DRIVER_UTILS_H
#define FUSEE_DRIVER_UTILS_H
#include "vsprintf.h"
#include "printk.h"
#endif

View file

@ -1,12 +1,13 @@
/** /**
* Fusée SD/MMC driver for the Switch * Fusée SD/MMC driver for the Switch
* ~ktemkin * ~ktemkin
*/ */
#include <string.h> #include <string.h>
#include <stdint.h> #include <stdint.h>
#include <errno.h> #include <errno.h>
#include "lib/driver_utils.h"
#include "sdmmc.h" #include "sdmmc.h"
#include "car.h" #include "car.h"
#include "pinmux.h" #include "pinmux.h"
@ -16,7 +17,6 @@
#include "supplies.h" #include "supplies.h"
#include "pmc.h" #include "pmc.h"
#include "pad_control.h" #include "pad_control.h"
#include "lib/printk.h"
#define TEGRA_SDMMC_BASE (0x700B0000) #define TEGRA_SDMMC_BASE (0x700B0000)
#define TEGRA_SDMMC_SIZE (0x200) #define TEGRA_SDMMC_SIZE (0x200)
@ -233,7 +233,7 @@ enum sdmmc_command {
CMD_SEND_EXT_CSD = 8, CMD_SEND_EXT_CSD = 8,
CMD_SEND_IF_COND = 8, CMD_SEND_IF_COND = 8,
CMD_SEND_CSD = 9, CMD_SEND_CSD = 9,
CMD_SEND_CID = 10, CMD_SEND_CID = 10,
CMD_STOP_TRANSMISSION = 12, CMD_STOP_TRANSMISSION = 12,
CMD_READ_STATUS = 13, CMD_READ_STATUS = 13,
CMD_BUS_TEST = 14, CMD_BUS_TEST = 14,
@ -315,7 +315,7 @@ enum sdmmc_csd_versions {
/** /**
* Positions of different fields in various CSDs. * Positions of different fields in various CSDs.
* May eventually be replaced with a bitfield struct, if we use enough of the 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) // Clear PAD_E_INPUT_OR_E_PWRD (relevant for eMMC only)
regs->sdmemcomppadctrl &= ~(0x80000000); regs->sdmemcomppadctrl &= ~(0x80000000);
// Set SDHCI_CLOCK_INT_EN // Set SDHCI_CLOCK_INT_EN
regs->clock_control |= 0x01; regs->clock_control |= 0x01;
// Program a timeout of 2000ms // Program a timeout of 2000ms
timebase = get_time(); timebase = get_time();
is_timeout = false; is_timeout = false;
// Wait for SDHCI_CLOCK_INT_STABLE to be set // Wait for SDHCI_CLOCK_INT_STABLE to be set
while (!(regs->clock_control & 0x02) && !is_timeout) { while (!(regs->clock_control & 0x02) && !is_timeout) {
// Keep checking if timeout expired // Keep checking if timeout expired
is_timeout = get_time_since(timebase) > 2000000; is_timeout = get_time_since(timebase) > 2000000;
} }
// Clock failed to stabilize // Clock failed to stabilize
if (is_timeout) { if (is_timeout) {
mmc_print(mmc, "clock never stabalized!"); mmc_print(mmc, "clock never stabalized!");
@ -814,7 +814,7 @@ static int sdmmc_hardware_init(struct mmc *mmc)
// Clear SDHCI_CTRL_HISPD // Clear SDHCI_CTRL_HISPD
regs->host_control &= 0xFB; regs->host_control &= 0xFB;
// Clear SDHCI_CTRL_VDD_180 // Clear SDHCI_CTRL_VDD_180
regs->host_control2 &= ~(0x08); regs->host_control2 &= ~(0x08);
// Set SDHCI_DIVIDER and SDHCI_DIVIDER_HI // 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. * Blocks until the SD driver has completed issuing a command.
* *
* @param mmc The MMC controller on which to wait. * @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 * will make this function return success
* @param fault_conditions A bitmask that specifies the bits that * @param fault_conditions A bitmask that specifies the bits that
* will make this function return EFAULT. * 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, * @return 0 on sucess, EFAULT if a fault condition occurs,
* or an error code if a transfer failure 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 target_irq, uint32_t fault_conditions)
{ {
uint32_t timebase = get_time(); 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 * @param auto_termiante True iff we should instruct the system
* to reclaim the data lines after a transaction. * 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) bool is_write, bool auto_terminate, int argument)
{ {
if (blocks) { 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, 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) 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; 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. // 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, * @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. * 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 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 * @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. * 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, static int sdmmc_send_command(struct mmc *mmc, enum sdmmc_command command,
enum sdmmc_response_type response_type, enum sdmmc_response_checks checks, 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) 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; 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]; uint8_t ext_csd[MMC_EXT_CSD_SIZE];
// Read the single EXT CSD block. // 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); MMC_CHECKS_ALL, 0, NULL, 1, false, false, ext_csd);
if (rc) { if (rc) {
mmc_print(mmc, "ERROR: failed to read the extended CSD!"); 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; uint32_t response_masked;
// Ask the SD card to identify its state. It will respond with readiness and a capacity magic. // 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); MMC_CHECKS_NONE, 0x40000080, response, 0, false, false, NULL);
if (rc) { if (rc) {
mmc_print(mmc, "ERROR: could not read the card's operating conditions!"); 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) 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. // Collapse our various parameters into a single argument.
uint32_t argument = uint32_t argument =
(mode << MMC_SWITCH_ACCESS_MODE_SHIFT) | (mode << MMC_SWITCH_ACCESS_MODE_SHIFT) |
(field << MMC_SWITCH_FIELD_SHIFT) | (field << MMC_SWITCH_FIELD_SHIFT) |
(value << MMC_SWITCH_VALUE_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) static void sdmmc_apply_card_type(struct mmc *mmc, enum sdmmc_card_type type)
{ {

View file

@ -3,8 +3,8 @@
* ~ktemkin * ~ktemkin
*/ */
#include "lib/driver_utils.h"
#include "supplies.h" #include "supplies.h"
#include "lib/printk.h"
// FIXME: replace hwinit with our own code // FIXME: replace hwinit with our own code
#include "hwinit/max7762x.h" #include "hwinit/max7762x.h"

View file

@ -0,0 +1,10 @@
#ifndef FUSEE_DRIVER_UTILS_H
#define FUSEE_DRIVER_UTILS_H
#include <stdio.h>
#include <stdarg.h>
#define vprintk vprintf
#define printk printf
#endif

View file

@ -2,12 +2,11 @@
* Fusée SD/MMC driver for the Switch * Fusée SD/MMC driver for the Switch
* ~ktemkin * ~ktemkin
*/ */
#include <stdio.h>
#include <stdarg.h>
#include <string.h> #include <string.h>
#include <stdint.h> #include <stdint.h>
#include <errno.h> #include <errno.h>
#include "lib/driver_utils.h"
#include "sdmmc.h" #include "sdmmc.h"
#include "car.h" #include "car.h"
#include "pinmux.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) if (sdmmc_loglevel < required_loglevel)
return; return;
printf("%s: ", mmc->name); printk("%s: ", mmc->name);
vprintf(fmt, list); vprintk(fmt, list);
printf("\n"); printk("\n");
} }
@ -732,7 +731,7 @@ static int sdmmc_set_up_clocking_parameters(struct mmc *mmc)
break; break;
default: 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; return ENODEV;
} }
@ -1480,7 +1479,7 @@ static uint32_t sdmmc_extract_csd_bits(uint32_t *csd, int start, int width)
// Sanity check our span. // Sanity check our span.
if ((start + width) > 128) { if ((start + width) > 128) {
printf("MMC ERROR: invalid CSD slice!\n"); printk("MMC ERROR: invalid CSD slice!\n");
return 0xFFFFFFFF; return 0xFFFFFFFF;
} }
@ -2205,7 +2204,7 @@ static void sdmmc_initialize_defaults(struct mmc *mmc)
break; break;
default: default:
printf("ERROR: initialization not yet writen for SDMMC%d", mmc->controller); printk("ERROR: initialization not yet writen for SDMMC%d", mmc->controller);
break; break;
} }
} }

View file

@ -3,7 +3,7 @@
* ~ktemkin * ~ktemkin
*/ */
#include <stdio.h> #include "lib/driver_utils.h"
#include "supplies.h" #include "supplies.h"
// FIXME: replace hwinit with our own code // FIXME: replace hwinit with our own code
@ -23,7 +23,7 @@ void supply_enable(enum switch_power_supply supply)
return; return;
default: default:
printf("ERROR: could not enable unknown supply %d!\n", supply); printk("ERROR: could not enable unknown supply %d!\n", supply);
return; return;
} }
} }