mirror of
https://github.com/Atmosphere-NX/Atmosphere.git
synced 2024-11-10 06:01:52 +00:00
Implement Clock/Reset Driver.
This commit is contained in:
parent
cad9cdc6e0
commit
5f7308efd1
2 changed files with 101 additions and 0 deletions
67
exosphere/src/car.c
Normal file
67
exosphere/src/car.c
Normal file
|
@ -0,0 +1,67 @@
|
|||
#include <stdint.h>
|
||||
|
||||
#include "utils.h"
|
||||
#include "car.h"
|
||||
#include "timers.h"
|
||||
|
||||
static inline uint32_t get_special_clk_reg(car_device_t dev) {
|
||||
switch (dev) {
|
||||
case CARDEVICE_UARTA: return 0x178;
|
||||
case CARDEVICE_UARTB: return 0x17C;
|
||||
case CARDEVICE_I2C1: return 0x124;
|
||||
case CARDEVICE_I2C5: return 0x128;
|
||||
case CARDEVICE_BPMP: return 0;
|
||||
default: generic_panic();
|
||||
}
|
||||
}
|
||||
|
||||
static inline uint32_t get_special_clk_val(car_device_t dev) {
|
||||
switch (dev) {
|
||||
case CARDEVICE_UARTA: return 0;
|
||||
case CARDEVICE_UARTB: return 0;
|
||||
case CARDEVICE_I2C1: return (6 << 29);
|
||||
case CARDEVICE_I2C5: return (6 << 29);
|
||||
case CARDEVICE_BPMP: return 0;
|
||||
default: generic_panic();
|
||||
}
|
||||
}
|
||||
|
||||
static uint32_t g_clk_reg_offsets[NUM_CAR_BANKS] = {0x320, 0x328, 0x330, 0x440, 0x448, 0x284, 0x29C};
|
||||
static uint32_t g_rst_reg_offsets[NUM_CAR_BANKS] = {0x300, 0x308, 0x310, 0x430, 0x438, 0x290, 0x2A8};
|
||||
|
||||
void clk_enable(car_device_t dev) {
|
||||
uint32_t special_reg;
|
||||
if ((special_reg = get_special_clk_reg(dev))) {
|
||||
MAKE_CAR_REG(special_reg) = get_special_clk_val(dev);
|
||||
}
|
||||
MAKE_CAR_REG(g_clk_reg_offsets[dev >> 5]) |= BIT((dev & 0x1F));
|
||||
}
|
||||
|
||||
void clk_disable(car_device_t dev) {
|
||||
MAKE_CAR_REG(g_clk_reg_offsets[dev >> 5] + 0x004) |= BIT((dev & 0x1F));
|
||||
}
|
||||
|
||||
void rst_enable(car_device_t dev) {
|
||||
MAKE_CAR_REG(g_rst_reg_offsets[dev >> 5]) |= BIT((dev & 0x1F));
|
||||
}
|
||||
|
||||
void rst_disable(car_device_t dev) {
|
||||
MAKE_CAR_REG(g_rst_reg_offsets[dev >> 5] + 0x004) |= BIT((dev & 0x1F));
|
||||
}
|
||||
|
||||
|
||||
void clkrst_enable(car_device_t dev) {
|
||||
clk_enable(dev);
|
||||
rst_disable(dev);
|
||||
}
|
||||
|
||||
void clkrst_disable(car_device_t dev) {
|
||||
rst_enable(dev);
|
||||
clk_disable(dev);
|
||||
}
|
||||
|
||||
void clkrst_reboot(car_device_t dev) {
|
||||
clkrst_disable(dev);
|
||||
wait(100);
|
||||
clkrst_enable(dev);
|
||||
}
|
34
exosphere/src/car.h
Normal file
34
exosphere/src/car.h
Normal file
|
@ -0,0 +1,34 @@
|
|||
#ifndef EXOSPHERE_CLOCK_AND_RESET_H
|
||||
#define EXOSPHERE_CLOCK_AND_RESET_H
|
||||
|
||||
#include <stdint.h>
|
||||
|
||||
#include "memory_map.h"
|
||||
|
||||
/* Exosphere Driver for the Tegra X1 Clock and Reset registers. */
|
||||
|
||||
#define CAR_BASE (MMIO_GET_DEVICE_ADDRESS(MMIO_DEVID_CLKRST))
|
||||
|
||||
#define MAKE_CAR_REG(n) (*((volatile uint32_t *)(CAR_BASE + n)))
|
||||
|
||||
#define NUM_CAR_BANKS 7
|
||||
|
||||
typedef enum {
|
||||
CARDEVICE_UARTA = 6,
|
||||
CARDEVICE_UARTB = 7,
|
||||
CARDEVICE_I2C1 = 12,
|
||||
CARDEVICE_I2C5 = 47,
|
||||
CARDEVICE_BPMP = 1
|
||||
} car_device_t;
|
||||
|
||||
void clk_enable(car_device_t dev);
|
||||
void clk_disable(car_device_t dev);
|
||||
void rst_enable(car_device_t dev);
|
||||
void rst_disable(car_device_t dev);
|
||||
|
||||
void clkrst_enable(car_device_t dev);
|
||||
void clkrst_disable(car_device_t dev);
|
||||
|
||||
void clkrst_reboot(car_device_t dev);
|
||||
|
||||
#endif
|
Loading…
Reference in a new issue