162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * Hantro VPU codec driver 462306a36Sopenharmony_ci * 562306a36Sopenharmony_ci * Copyright (C) 2021 Collabora Ltd, Andrzej Pietrasiewicz <andrzej.p@collabora.com> 662306a36Sopenharmony_ci */ 762306a36Sopenharmony_ci 862306a36Sopenharmony_ci#include "hantro_hw.h" 962306a36Sopenharmony_ci#include "hantro_g2_regs.h" 1062306a36Sopenharmony_ci 1162306a36Sopenharmony_civoid hantro_g2_check_idle(struct hantro_dev *vpu) 1262306a36Sopenharmony_ci{ 1362306a36Sopenharmony_ci int i; 1462306a36Sopenharmony_ci 1562306a36Sopenharmony_ci for (i = 0; i < 3; i++) { 1662306a36Sopenharmony_ci u32 status; 1762306a36Sopenharmony_ci 1862306a36Sopenharmony_ci /* Make sure the VPU is idle */ 1962306a36Sopenharmony_ci status = vdpu_read(vpu, G2_REG_INTERRUPT); 2062306a36Sopenharmony_ci if (status & G2_REG_INTERRUPT_DEC_E) { 2162306a36Sopenharmony_ci dev_warn(vpu->dev, "device still running, aborting"); 2262306a36Sopenharmony_ci status |= G2_REG_INTERRUPT_DEC_ABORT_E | G2_REG_INTERRUPT_DEC_IRQ_DIS; 2362306a36Sopenharmony_ci vdpu_write(vpu, status, G2_REG_INTERRUPT); 2462306a36Sopenharmony_ci } 2562306a36Sopenharmony_ci } 2662306a36Sopenharmony_ci} 2762306a36Sopenharmony_ci 2862306a36Sopenharmony_ciirqreturn_t hantro_g2_irq(int irq, void *dev_id) 2962306a36Sopenharmony_ci{ 3062306a36Sopenharmony_ci struct hantro_dev *vpu = dev_id; 3162306a36Sopenharmony_ci enum vb2_buffer_state state; 3262306a36Sopenharmony_ci u32 status; 3362306a36Sopenharmony_ci 3462306a36Sopenharmony_ci status = vdpu_read(vpu, G2_REG_INTERRUPT); 3562306a36Sopenharmony_ci state = (status & G2_REG_INTERRUPT_DEC_RDY_INT) ? 3662306a36Sopenharmony_ci VB2_BUF_STATE_DONE : VB2_BUF_STATE_ERROR; 3762306a36Sopenharmony_ci 3862306a36Sopenharmony_ci vdpu_write(vpu, 0, G2_REG_INTERRUPT); 3962306a36Sopenharmony_ci vdpu_write(vpu, G2_REG_CONFIG_DEC_CLK_GATE_E, G2_REG_CONFIG); 4062306a36Sopenharmony_ci 4162306a36Sopenharmony_ci hantro_irq_done(vpu, state); 4262306a36Sopenharmony_ci 4362306a36Sopenharmony_ci return IRQ_HANDLED; 4462306a36Sopenharmony_ci} 45