crsn/crsn_arith/src/parse.rs

use crsn::asm::data::{Rd, Wr, DataDispEquals};
use crsn::asm::error::CrsnError;
use crsn::asm::instr::op::OpKind;
use crsn::asm::parse::arg_parser::TokenParser;
use crsn::module::ParseRes;
use crsn::sexp::SourcePosition;

use crate::defs::ArithOp;


pub(crate) fn parse<'a>(op_pos: &SourcePosition, keyword: &str, mut args: TokenParser<'a>) -> Result<ParseRes<'a, OpKind>, CrsnError> {
    Ok(ParseRes::ext(match keyword {
        "cmp" => {
            ArithOp::Compare {
                a: args.next_rd()?,
                b: args.next_rd()?,
            }
        }

        "rcmp" => {
            ArithOp::RangeTest {
                val: args.next_rd()?,
                a: args.next_rd()?,
                b: args.next_rd()?,
            }
        }

        "tst" => {
            let arg = args.next_rd()?;
            ArithOp::Test { a: arg }
        }

        "rng" => {
            match args.len() {
                1 => {
                    ArithOp::Rng {
                        dst: args.next_wr()?,
                        min: Rd::immediate(0),
                        max: Rd::immediate(u64::MAX),
                    }
                }
                2 => {
                    ArithOp::Rng {
                        dst: args.next_wr()?,
                        min: Rd::immediate(0),
                        max: args.next_rd()?,
                    }
                }
                3 => {
                    ArithOp::Rng {
                        dst: args.next_wr()?,
                        min: args.next_rd()?,
                        max: args.next_rd()?,
                    }
                }
                _ => {
                    return Err(CrsnError::Parse("Rng requires 1, 2 or 3 arguments".into(), op_pos.clone()));
                }
            }
        }

        "inc" => {
            let dst = args.next_rdwr()?;
            ArithOp::Add {
                dst: dst.wr(),
                a: dst.rd(),
                b: Rd::immediate(1),
            }
        }

        "dec" => {
            let dst = args.next_rdwr()?;
            ArithOp::Sub {
                dst: dst.wr(),
                a: dst.rd(),
                b: Rd::immediate(1),
            }
        }

        "add" => {
            match args.len() {
                3 => {
                    ArithOp::Add {
                        dst: args.next_wr()?,
                        a: args.next_rd()?,
                        b: args.next_rd()?,
                    }
                }
                2 => {
                    let dst = args.next_rdwr()?;
                    ArithOp::Add {
                        dst: dst.wr(),
                        a: dst.rd(),
                        b: args.next_rd()?,
                    }
                }
                _ => {
                    return Err(CrsnError::Parse("Add requires 2 or 3 arguments".into(), op_pos.clone()));
                }
            }
        }

        "sub" => {
            match args.len() {
                3 => {
                    ArithOp::Sub {
                        dst: args.next_wr()?,
                        a: args.next_rd()?,
                        b: args.next_rd()?,
                    }
                }
                2 => {
                    let dst = args.next_rdwr()?;
                    ArithOp::Sub {
                        dst: dst.wr(),
                        a: dst.rd(),
                        b: args.next_rd()?,
                    }
                }
                _ => {
                    return Err(CrsnError::Parse("Sub requires 2 or 3 arguments".into(), op_pos.clone()));
                }
            }
        }

        "mul" => {
            match args.len() {
                3 => {
                    ArithOp::Mul {
                        dst: args.next_wr()?,
                        a: args.next_rd()?,
                        b: args.next_rd()?,
                    }
                }
                2 => {
                    let dst = args.next_rdwr()?;
                    ArithOp::Mul {
                        dst: dst.wr(),
                        a: dst.rd(),
                        b: args.next_rd()?,
                    }
                }
                _ => {
                    return Err(CrsnError::Parse("Mul requires 2 or 3 arguments".into(), op_pos.clone()));
                }
            }
        }

        "divr" => {
            match args.len() {
                3 => {
                    let dst = args.next_rdwr()?;
                    let rem = args.next_wr()?;
                    let div = args.next_rd()?;
                    ArithOp::Div {
                        dst: dst.wr(),
                        rem,
                        a: dst.rd(),
                        div,
                    }
                }
                4 => {
                    ArithOp::Div {
                        dst: args.next_wr()?,
                        rem: args.next_wr()?,
                        a: args.next_rd()?,
                        div: args.next_rd()?,
                    }
                }
                _ => {
                    return Err(CrsnError::Parse("DivR requires 3 or 4 arguments".into(), op_pos.clone()));
                }
            }
        }

        "div" => {
            match args.len() {
                3 => {
                    ArithOp::Div {
                        dst: args.next_wr()?,
                        rem: Wr::discard(),
                        a: args.next_rd()?,
                        div: args.next_rd()?,
                    }
                }
                2 => {
                    let dst = args.next_rdwr()?;
                    let div = args.next_rd()?;
                    ArithOp::Div {
                        dst: dst.wr(),
                        rem: Wr::discard(),
                        a: dst.rd(),
                        div,
                    }
                }
                _ => {
                    return Err(CrsnError::Parse("Div requires 2 or 3 arguments".into(), op_pos.clone()));
                }
            }
        }

        "mod" => {
            match args.len() {
                3 => {
                    ArithOp::Mod {
                        dst: args.next_wr()?,
                        a: args.next_rd()?,
                        div: args.next_rd()?,
                    }
                }
                2 => {
                    let dst = args.next_rdwr()?;
                    let div = args.next_rd()?;
                    ArithOp::Mod {
                        dst: dst.wr(),
                        a: dst.rd(),
                        div,
                    }
                }
                _ => {
                    return Err(CrsnError::Parse("Mod requires 2 or 3 arguments".into(), op_pos.clone()));
                }
            }
        }

        "and" => {
            match args.len() {
                3 => {
                    ArithOp::And {
                        dst: args.next_wr()?,
                        a: args.next_rd()?,
                        b: args.next_rd()?,
                    }
                }
                2 => {
                    let dst = args.next_rdwr()?;
                    ArithOp::And {
                        dst: dst.wr(),
                        a: dst.rd(),
                        b: args.next_rd()?,
                    }
                }
                _ => {
                    return Err(CrsnError::Parse("And requires 2 or 3 arguments".into(), op_pos.clone()));
                }
            }
        }

        "or" => {
            match args.len() {
                3 => {
                    ArithOp::Or {
                        dst: args.next_wr()?,
                        a: args.next_rd()?,
                        b: args.next_rd()?,
                    }
                }
                2 => {
                    let dst = args.next_rdwr()?;
                    ArithOp::Or {
                        dst: dst.wr(),
                        a: dst.rd(),
                        b: args.next_rd()?,
                    }
                }
                _ => {
                    return Err(CrsnError::Parse("Or requires 2 or 3 arguments".into(), op_pos.clone()));
                }
            }
        }

        "xor" => {
            match args.len() {
                3 => {
                    ArithOp::Xor {
                        dst: args.next_wr()?,
                        a: args.next_rd()?,
                        b: args.next_rd()?,
                    }
                }
                2 => {
                    let dst = args.next_rdwr()?;
                    ArithOp::Xor {
                        dst: dst.wr(),
                        a: dst.rd(),
                        b: args.next_rd()?,
                    }
                }
                _ => {
                    return Err(CrsnError::Parse("Xor requires 2 or 3 arguments".into(), op_pos.clone()));
                }
            }
        }

        "cpl" => {
            match args.len() {
                2 => {
                    ArithOp::Cpl {
                        dst: args.next_wr()?,
                        a: args.next_rd()?,
                    }
                }
                1 => {
                    let dst = args.next_rdwr()?;
                    ArithOp::Cpl {
                        dst: dst.wr(),
                        a: dst.rd(),
                    }
                }
                _ => {
                    return Err(CrsnError::Parse("Cpl requires 1 or 2 arguments".into(), op_pos.clone()));
                }
            }
        }

        "rol" => {
            match args.len() {
                3 => {
                    ArithOp::Rol {
                        dst: args.next_wr()?,
                        a: args.next_rd()?,
                        n: args.next_rd()?,
                    }
                }
                2 => {
                    let dst = args.next_rdwr()?;
                    ArithOp::Rol {
                        dst: dst.wr(),
                        a: dst.rd(),
                        n: args.next_rd()?,
                    }
                }
                1 => {
                    let dst = args.next_rdwr()?;
                    ArithOp::Rol {
                        dst: dst.wr(),
                        a: dst.rd(),
                        n: Rd::immediate(1),
                    }
                }
                _ => {
                    return Err(CrsnError::Parse("Rol requires 1, 2 or 3 arguments".into(), op_pos.clone()));
                }
            }
        }

        "ror" => {
            match args.len() {
                3 => {
                    ArithOp::Ror {
                        dst: args.next_wr()?,
                        a: args.next_rd()?,
                        n: args.next_rd()?,
                    }
                }
                2 => {
                    let dst = args.next_rdwr()?;
                    ArithOp::Ror {
                        dst: dst.wr(),
                        a: dst.rd(),
                        n: args.next_rd()?,
                    }
                }
                1 => {
                    let dst = args.next_rdwr()?;
                    ArithOp::Ror {
                        dst: dst.wr(),
                        a: dst.rd(),
                        n: Rd::immediate(1),
                    }
                }
                _ => {
                    return Err(CrsnError::Parse("Ror requires 1, 2 or 3 arguments".into(), op_pos.clone()));
                }
            }
        }

        "lsl" | "asl" => {
            match args.len() {
                3 => {
                    ArithOp::Lsl {
                        dst: args.next_wr()?,
                        a: args.next_rd()?,
                        n: args.next_rd()?,
                    }
                }
                2 => {
                    let dst = args.next_rdwr()?;
                    ArithOp::Lsl {
                        dst: dst.wr(),
                        a: dst.rd(),
                        n: args.next_rd()?,
                    }
                }
                1 => {
                    let dst = args.next_rdwr()?;
                    ArithOp::Lsl {
                        dst: dst.wr(),
                        a: dst.rd(),
                        n: Rd::immediate(1),
                    }
                }
                _ => {
                    return Err(CrsnError::Parse("Lsl requires 1, 2 or 3 arguments".into(), op_pos.clone()));
                }
            }
        }

        "lsr" => {
            match args.len() {
                3 => {
                    ArithOp::Lsr {
                        dst: args.next_wr()?,
                        a: args.next_rd()?,
                        n: args.next_rd()?,
                    }
                }
                2 => {
                    let dst = args.next_rdwr()?;
                    ArithOp::Lsr {
                        dst: dst.wr(),
                        a: dst.rd(),
                        n: args.next_rd()?,
                    }
                }
                1 => {
                    let dst = args.next_rdwr()?;
                    ArithOp::Lsr {
                        dst: dst.wr(),
                        a: dst.rd(),
                        n: Rd::immediate(1),
                    }
                }
                _ => {
                    return Err(CrsnError::Parse("Lsr requires 1, 2 or 3 arguments".into(), op_pos.clone()));
                }
            }
        }

        "asr" => {
            match args.len() {
                3 => {
                    ArithOp::Asr {
                        dst: args.next_wr()?,
                        a: args.next_rd()?,
                        n: args.next_rd()?,
                    }
                }
                2 => {
                    let dst = args.next_rdwr()?;
                    ArithOp::Asr {
                        dst: dst.wr(),
                        a: dst.rd(),
                        n: args.next_rd()?,
                    }
                }
                1 => {
                    let dst = args.next_rdwr()?;
                    ArithOp::Asr {
                        dst: dst.wr(),
                        a: dst.rd(),
                        n: Rd::immediate(1),
                    }
                }
                _ => {
                    return Err(CrsnError::Parse("Asr requires 1, 2 or 3 arguments".into(), op_pos.clone()));
                }
            }
        }

        "sw32" => {
            match args.len() {
                2 => {
                    ArithOp::Sw32 {
                        dst: args.next_wr()?,
                        src: args.next_rd()?,
                    }
                }
                1 => {
                    let dst = args.next_rdwr()?;
                    ArithOp::Sw32 {
                        dst: dst.wr(),
                        src: dst.rd(),
                    }
                }
                _ => {
                    return Err(CrsnError::Parse("SW32 requires 1 or 2 arguments".into(), op_pos.clone()));
                }
            }
        }

        "sw16" => {
            match args.len() {
                2 => {
                    ArithOp::Sw16 {
                        dst: args.next_wr()?,
                        src: args.next_rd()?,
                    }
                }
                1 => {
                    let dst = args.next_rdwr()?;
                    ArithOp::Sw16 {
                        dst: dst.wr(),
                        src: dst.rd(),
                    }
                }
                _ => {
                    return Err(CrsnError::Parse("SW16 requires 1 or 2 arguments".into(), op_pos.clone()));
                }
            }
        }

        "sw8" => {
            match args.len() {
                2 => {
                    ArithOp::Sw8 {
                        dst: args.next_wr()?,
                        src: args.next_rd()?,
                    }
                }
                1 => {
                    let dst = args.next_rdwr()?;
                    ArithOp::Sw8 {
                        dst: dst.wr(),
                        src: dst.rd(),
                    }
                }
                _ => {
                    return Err(CrsnError::Parse("SW8 requires 1 or 2 arguments".into(), op_pos.clone()));
                }
            }
        }

        "rev" => {
            match args.len() {
                2 => {
                    ArithOp::Rev {
                        dst: args.next_wr()?,
                        src: args.next_rd()?,
                    }
                }
                1 => {
                    let dst = args.next_rdwr()?;
                    ArithOp::Rev {
                        dst: dst.wr(),
                        src: dst.rd(),
                    }
                }
                _ => {
                    return Err(CrsnError::Parse("REV requires 1 or 2 arguments".into(), op_pos.clone()));
                }
            }
        }

        "rbit" => {
            match args.len() {
                2 => {
                    ArithOp::Rbit {
                        dst: args.next_wr()?,
                        src: args.next_rd()?,
                    }
                }
                1 => {
                    let dst = args.next_rdwr()?;
                    ArithOp::Rbit {
                        dst: dst.wr(),
                        src: dst.rd(),
                    }
                }
                _ => {
                    return Err(CrsnError::Parse("RBIT requires 1 or 2 arguments".into(), op_pos.clone()));
                }
            }
        }

        other => {
            if let Some((dst, src, mask)) = args.parse_masked_wr_rd(other, "clz")? {
                if !dst.disp_equals(src) && mask.dst_pos != 0 {
                    return Err(CrsnError::Parse(
                        "Invalid offsets - permissible formats are (RW:src_offs) and (Wr Rd:src_offs) ".into(),
                        op_pos.clone()));
                }
                return Ok(ParseRes::ext(ArithOp::Clz {
                    dst,
                    src,
                    mask
                }));
            }

            if let Some((dst, src, mask)) = args.parse_masked_wr_rd(other, "clo")? {
                if !dst.disp_equals(src) && mask.dst_pos != 0 {
                    return Err(CrsnError::Parse(
                        "Invalid offsets - permissible formats are (RW:src_offs) and (Wr Rd:src_offs)".into(),
                        op_pos.clone()));
                }
                return Ok(ParseRes::ext(ArithOp::Clo {
                    dst,
                    src,
                    mask
                }));
            }

            if let Some((dst, src, mask)) = args.parse_masked_wr_rd(other, "se")? {
                if mask.src_pos != 0 || mask.dst_pos != 0 {
                    return Err(CrsnError::Parse(
                        "Offsets do not make sense for SignExtend".into(),
                        op_pos.clone()));
                }
                return Ok(ParseRes::ext(ArithOp::SignExtend {
                    dst,
                    src,
                    mask
                }));
            }

            return Ok(ParseRes::Unknown(args));
        }
    }))
}