Method update_command_queue

kernel/kernel/Input/PS2/Controller.cpp:137–166

		});
		return true;
	}

	void PS2Controller::update_command_queue()
	{
		Command command_copy;

		{
			SpinLockGuard _(m_command_lock);

			if (m_command_queue.empty())
				return;
			auto& command = m_command_queue.front();
			if (command.state == Command::State::WaitingResponse || command.state == Command::State::WaitingAck)
			{
				if (SystemTimer::get().ms_since_boot() >= m_command_send_time + s_ps2_timeout_ms)
				{
					dwarnln_if(DEBUG_PS2, "Command timedout");
					m_devices[command.device_index]->command_timedout(command.out_data, command.out_count);
					m_command_queue.pop();
				}
				return;
			}
			ASSERT(command.send_index < command.out_count);
			command.state = Command::State::WaitingAck;

			command_copy = command;
		}

		m_command_send_time = SystemTimer::get().ms_since_boot();
		if (auto ret = device_send_byte(command_copy.device_index, command_copy.out_data[command_copy.send_index]); ret.is_error())
			dwarnln_if(DEBUG_PS2, "PS/2 send command byte: {}", ret.error());
	}