Ported CDIOs
This commit is contained in:
@@ -22,26 +22,26 @@ namespace JabyEngine {
|
||||
}
|
||||
|
||||
template<typename...ARGS>
|
||||
static void send(CD_IO::CommandFifo_t& cmd_fifo, CD_IO::ParameterFifo_t& parameter_fifo, CD_IO::Command::Info cmd, ARGS...args) {
|
||||
while(CD_IO::IndexStatus.read().is_bit_set(CD_IO::IndexStatus::IsTransmissionBusy));
|
||||
static void send(CD_IO::CommandFifo_v& cmd_fifo, CD_IO::ParameterFifo_v& parameter_fifo, CD_IO::Command::Desc cmd, ARGS...args) {
|
||||
while(CD_IO::IndexStatus.is_set(CD_IO::IndexStatus_t::IsTransmissionBusy));
|
||||
|
||||
(parameter_fifo.write(static_cast<uint8_t>(args)), ...);
|
||||
cmd_fifo.write(cmd.id);
|
||||
((parameter_fifo = args),...);
|
||||
cmd_fifo = cmd.id;
|
||||
}
|
||||
|
||||
template<typename T, typename...ARGS>
|
||||
static void send(CD_IO::Command::Info cmd, ARGS...args) {
|
||||
static void send(CD_IO::Command::Desc cmd, ARGS...args) {
|
||||
send(T::CommandFifo, T::ParameterFifo, cmd, args...);
|
||||
}
|
||||
|
||||
template<typename...ARGS>
|
||||
static void send_wait(CD_IO::CommandFifo_t& cmd_fifo, CD_IO::ParameterFifo_t& parameter_fifo, CD_IO::Command::Info cmd, ARGS...args) {
|
||||
static void send_wait(CD_IO::CommandFifo_v& cmd_fifo, CD_IO::ParameterFifo_v& parameter_fifo, CD_IO::Command::Desc cmd, ARGS...args) {
|
||||
send(cmd_fifo, parameter_fifo, cmd, args...);
|
||||
wait_until(cmd.complete_irq);
|
||||
}
|
||||
|
||||
template<typename T, typename...ARGS>
|
||||
static void send_wait(CD_IO::Command::Info cmd, ARGS...args) {
|
||||
static void send_wait(CD_IO::Command::Desc cmd, ARGS...args) {
|
||||
send_wait(T::CommandFifo, T::ParameterFifo, cmd, args...);
|
||||
}
|
||||
};
|
||||
|
@@ -22,8 +22,8 @@ namespace JabyEngine {
|
||||
__syscall_SysEnqIntRP(CdromIoIrq, &::JabyEngine::CD::internal::callback);
|
||||
|
||||
CD_IO::PortIndex1::change_to();
|
||||
CD_IO::Interrupt::ack_extended(CD_IO::PortIndex1::InterruptFlagRegister);
|
||||
CD_IO::Interrupt::enable(CD_IO::PortIndex1::InterruptEnableRegister);
|
||||
CD_IO::Interrupt::ack_extended(CD_IO::PortIndex1::InterruptFlag);
|
||||
CD_IO::Interrupt::enable(CD_IO::PortIndex1::InterruptEnable);
|
||||
|
||||
Interrupt::ack_irq(Interrupt::CDROM);
|
||||
Interrupt::enable_irq(Interrupt::CDROM);
|
||||
|
@@ -31,12 +31,12 @@ namespace JabyEngine {
|
||||
};
|
||||
|
||||
if(Interrupt::is_irq(Interrupt::CDROM)) {
|
||||
const uint8_t old_idx = (CD_IO::IndexStatus.read() & 0x3);
|
||||
const uint8_t old_idx = (*CD_IO::IndexStatus & 0x3);
|
||||
|
||||
CD_IO::PortIndex1::change_to();
|
||||
const auto cur_irq = CD_IO::Interrupt::get_type(CD_IO::PortIndex1::InterruptFlagRegister);
|
||||
const auto cur_irq = CD_IO::Interrupt::get_type(CD_IO::PortIndex1::InterruptFlag);
|
||||
last_interrupt = cur_irq;
|
||||
CD_IO::Interrupt::ack(CD_IO::PortIndex1::InterruptFlagRegister);
|
||||
CD_IO::Interrupt::ack(CD_IO::PortIndex1::InterruptFlag);
|
||||
|
||||
if(cur_irq == CD_IO::Interrupt::DataReady) {
|
||||
//Obtain sector content here
|
||||
@@ -67,7 +67,7 @@ namespace JabyEngine {
|
||||
current_state = State::Error;
|
||||
}
|
||||
|
||||
CD_IO::IndexStatus.write({old_idx});
|
||||
CD_IO::IndexStatus = old_idx;
|
||||
return InterruptVerifierResult::ExecuteHandler;
|
||||
}
|
||||
|
||||
|
Reference in New Issue
Block a user