/* Assemble V850 instructions.

   Copyright (C) 1996-2023 Free Software Foundation, Inc.

   This file is part of the GNU opcodes library.

   This library is free software; you can redistribute it and/or modify

   it under the terms of the GNU General Public License as published by

   the Free Software Foundation; either version 3, or (at your option)

   any later version.

   It is distributed in the hope that it will be useful, but WITHOUT

   ANY WARRANTY; without even the implied warranty of MERCHANTABILITY

   or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public

   License for more details.

   You should have received a copy of the GNU General Public License

   along with this program; if not, write to the Free Software

   Foundation, Inc., 51 Franklin Street - Fifth Floor, Boston,

   MA 02110-1301, USA.  */

#include "sysdep.h"

#include <stdio.h>

#include "opcode/v850.h"

#include "bfd.h"

#include "opintl.h"

/* Regular opcodes.  */

#define OP(x)   ((x & 0x3f) << 5)

#define OP_MASK   OP (0x3f)

/* Conditional branch opcodes (Format III).  */

#define BOP(x)    ((0x58 << 4) | (x & 0x0f))

#define BOP_MASK  ((0x78 << 4) | 0x0f)

/* Conditional branch opcodes (Format VII).  */

#define BOP7(x)   (0x107e0 | (x & 0xf))

#define BOP7_MASK (0x1ffe0 | 0xf)

/* One-word opcodes.  */

#define one(x)    ((unsigned int) (x))

/* Two-word opcodes.  */

#define two(x,y)  ((unsigned int) (x) | ((unsigned int) (y) << 16))

/* The functions used to insert and extract complicated operands.  */

/* Note: There is a conspiracy between these functions and

   v850_insert_operand() in gas/config/tc-v850.c.  Error messages

   containing the string 'out of range' will be ignored unless a

   specific command line option is given to GAS.  */

static const char * not_valid    = N_ ("displacement value is not in range and is not aligned");

static const char * out_of_range = N_ ("displacement value is out of range");

static const char * not_aligned  = N_ ("displacement value is not aligned");

static const char * immediate_out_of_range = N_ ("immediate value is out of range");

static const char * branch_out_of_range = N_ ("branch value out of range");

static const char * branch_out_of_range_and_odd_offset = N_ ("branch value not in range and to odd offset");

static const char * branch_to_odd_offset = N_ ("branch to odd offset");

static const char * pos_out_of_range = N_ ("position value is out of range");

static const char * width_out_of_range = N_ ("width value is out of range");

static const char * selid_out_of_range = N_ ("SelID is out of range");

static const char * vector8_out_of_range = N_ ("vector8 is out of range");

static const char * vector5_out_of_range = N_ ("vector5 is out of range");

static const char * imm10_out_of_range = N_ ("imm10 is out of range");

static const char * sr_selid_out_of_range = N_ ("SR/SelID is out of range");

int

v850_msg_is_out_of_range (const char* msg)

{

  return msg == out_of_range

    || msg == immediate_out_of_range

    || msg == branch_out_of_range;

}

static unsigned long

insert_i5div1 (unsigned long insn, unsigned long value, const char ** errmsg)

{

  if (value > 30 || value < 2)

    {

      if (value & 1)

  * errmsg = _(not_valid);

      else

  * errmsg = _(out_of_range);

    }

  else if (value & 1)

    * errmsg = _(not_aligned);

  value = (32 - value)/2;

  return (insn | ((value << (2+16)) & 0x3c0000));

}

static unsigned long

extract_i5div1 (unsigned long insn, int * invalid)

{

  unsigned long ret = (insn & 0x003c0000) >> (16+2);

  ret = 32 - (ret * 2);

  if (invalid != 0)

    *invalid = (ret > 30 || ret < 2) ? 1 : 0;

  return ret;

}

static unsigned long

insert_i5div2 (unsigned long insn, unsigned long value, const char ** errmsg)

{

  if (value > 30 || value < 4)

    {

      if (value & 1)

  * errmsg = _(not_valid);

      else

  * errmsg = _(out_of_range);

    }

  else if (value & 1)

    * errmsg = _(not_aligned);

  value = (32 - value)/2;

  return insn | ((value << (2 + 16)) & 0x3c0000);

}

static unsigned long

extract_i5div2 (unsigned long insn, int * invalid)

{

  unsigned long ret = (insn & 0x003c0000) >> (16+2);

  ret = 32 - (ret * 2);

  if (invalid != 0)

    *invalid = (ret > 30 || ret < 4) ? 1 : 0;

  return ret;

}

static unsigned long

insert_i5div3 (unsigned long insn, unsigned long value, const char ** errmsg)

{

  if (value > 32 || value < 2)

    {

      if (value & 1)

  * errmsg = _(not_valid);

      else

  * errmsg = _(out_of_range);

    }

  else if (value & 1)

    * errmsg = _(not_aligned);

  value = (32 - value)/2;

  return insn | ((value << (2+16)) & 0x3c0000);

}

static unsigned long

extract_i5div3 (unsigned long insn, int * invalid)

{

  unsigned long ret = (insn & 0x003c0000) >> (16+2);

  ret = 32 - (ret * 2);

  if (invalid != 0)

    *invalid = (ret > 32 || ret < 2) ? 1 : 0;

  return ret;

}

static unsigned long

insert_d5_4 (unsigned long insn, unsigned long value, const char ** errmsg)

{

  if (value > 0x1f)

    {

      if (value & 1)

  * errmsg = _(not_valid);

      else

  * errmsg = _(out_of_range);

    }

  else if (value & 1)

    * errmsg = _(not_aligned);

  value >>= 1;

  return insn | (value & 0x0f);

}

static unsigned long

extract_d5_4 (unsigned long insn, int * invalid)

{

  unsigned long ret = (insn & 0x0f);

  ret <<= 1;

  if (invalid != 0)

    *invalid = 0;

  return ret;

}

static unsigned long

insert_d8_6 (unsigned long insn, unsigned long value, const char ** errmsg)

{

  if (value > 0xff)

    {

      if ((value % 4) != 0)

  * errmsg = _(not_valid);

      else

  * errmsg = _(out_of_range);

    }

  else if ((value % 4) != 0)

    * errmsg = _(not_aligned);

  value >>= 1;

  return insn | (value & 0x7e);

}

static unsigned long

extract_d8_6 (unsigned long insn, int * invalid)

{

  unsigned long ret = (insn & 0x7e);

  ret <<= 1;

  if (invalid != 0)

    *invalid = 0;

  return ret;

}

static unsigned long

insert_d8_7 (unsigned long insn, unsigned long value, const char ** errmsg)

{

  if (value > 0xff)

    {

      if ((value % 2) != 0)

  * errmsg = _(not_valid);

      else

  * errmsg = _(out_of_range);

    }

  else if ((value % 2) != 0)

    * errmsg = _(not_aligned);

  value >>= 1;

  return insn | (value & 0x7f);

}

static unsigned long

extract_d8_7 (unsigned long insn, int * invalid)

{

  unsigned long ret = (insn & 0x7f);

  ret <<= 1;

  if (invalid != 0)

    *invalid = 0;

  return ret;

}

static unsigned long

insert_v8 (unsigned long insn, unsigned long value, const char ** errmsg)

{

  if (value > 0xff)

    * errmsg = _(immediate_out_of_range);

  return insn | (value & 0x1f) | ((value & 0xe0) << (27-5));

}

static unsigned long

extract_v8 (unsigned long insn, int * invalid)

{

  unsigned long ret = (insn & 0x1f) | ((insn >> (27-5)) & 0xe0);

  if (invalid != 0)

    *invalid = 0;

  return ret;

}

static unsigned long

insert_d9 (unsigned long insn, unsigned long value, const char ** errmsg)

{

  if (value + 0x100 > 0x1ff)

    {

      if ((value % 2) != 0)

  * errmsg = branch_out_of_range_and_odd_offset;

      else

  * errmsg = branch_out_of_range;

    }

  else if ((value % 2) != 0)

    * errmsg = branch_to_odd_offset;

  return insn | ((value & 0x1f0) << 7) | ((value & 0x0e) << 3);

}

static unsigned long

extract_d9 (unsigned long insn, int * invalid)

{

  unsigned long ret = ((insn >> 7) & 0x1f0) | ((insn >> 3) & 0x0e);

  ret = (ret ^ 0x100) - 0x100;

  if (invalid != 0)

    *invalid = 0;

  return ret;

}

static unsigned long

insert_u16_loop (unsigned long insn, unsigned long value, const char ** errmsg)

{

  /* Loop displacement is encoded as a positive value,

     even though the instruction branches backwards.  */

  if (value > 0xffff)

    {

      if ((value % 2) != 0)

  * errmsg = branch_out_of_range_and_odd_offset;

      else

  * errmsg = branch_out_of_range;

    }

  else if ((value % 2) != 0)

    * errmsg = branch_to_odd_offset;

  return insn | ((value & 0xfffe) << 16);

}

static unsigned long

extract_u16_loop (unsigned long insn, int * invalid)

{

  long ret = (insn >> 16) & 0xfffe;

  if (invalid != 0)

    *invalid = 0;

  return ret;

}

static unsigned long

insert_d16_15 (unsigned long insn, unsigned long value, const char ** errmsg)

{

  if (value + 0x8000 > 0xffff)

    {

      if ((value % 2) != 0)

  * errmsg = _(not_valid);

      else

  * errmsg = _(out_of_range);

    }

  else if ((value % 2) != 0)

    * errmsg = _(not_aligned);

  return insn | ((value & 0xfffe) << 16);

}

static unsigned long

extract_d16_15 (unsigned long insn, int * invalid)

{

  unsigned long ret = (insn >> 16) & 0xfffe;

  ret = (ret ^ 0x8000) - 0x8000;

  if (invalid != 0)

    *invalid = 0;

  return ret;

}

static unsigned long

insert_d16_16 (unsigned long insn, unsigned long value, const char ** errmsg)

{

  if (value + 0x8000 > 0xffff)

    * errmsg = _(out_of_range);

  return insn | ((value & 0xfffe) << 16) | ((value & 1) << 5);

}

static unsigned long

extract_d16_16 (unsigned long insn, int * invalid)

{

  unsigned long ret = ((insn >> 16) & 0xfffe) | ((insn >> 5) & 1);

  ret = (ret ^ 0x8000) - 0x8000;

  if (invalid != 0)

    *invalid = 0;

  return ret;

}

static unsigned long

insert_d17_16 (unsigned long insn, unsigned long value, const char ** errmsg)

{

  if (value + 0x10000 > 0x1ffff)

    * errmsg = _(out_of_range);

  return insn | ((value & 0xfffe) << 16) | ((value & 0x10000) >> (16 - 4));

}

static unsigned long

extract_d17_16 (unsigned long insn, int * invalid)

{

  unsigned long ret = ((insn >> 16) & 0xfffe) | ((insn << (16 - 4)) & 0x10000);

  ret = (ret ^ 0x10000) - 0x10000;

  if (invalid != 0)

    *invalid = 0;

  return ret;

}

static unsigned long

insert_d22 (unsigned long insn, unsigned long value, const char ** errmsg)

{

  if (value + 0x200000 > 0x3fffff)

    {

      if ((value % 2) != 0)

  * errmsg = branch_out_of_range_and_odd_offset;

      else

  * errmsg = branch_out_of_range;

    }

  else if ((value % 2) != 0)

    * errmsg = branch_to_odd_offset;

  return insn | ((value & 0xfffe) << 16) | ((value & 0x3f0000) >> 16);

}

static unsigned long

extract_d22 (unsigned long insn, int * invalid)

{

  unsigned long ret = ((insn >> 16) & 0xfffe) | ((insn << 16) & 0x3f0000);

  ret = (ret ^ 0x200000) - 0x200000;

  if (invalid != 0)

    *invalid = 0;

  return ret;

}

static unsigned long

insert_d23 (unsigned long insn, unsigned long value, const char ** errmsg)

{

  if (value + 0x400000 > 0x7fffff)

    * errmsg = out_of_range;

  return insn | ((value & 0x7f) << 4) | ((value & 0x7fff80) << (16-7));

}

static unsigned long

insert_d23_align1 (unsigned long insn, unsigned long value, const char ** errmsg)

{

  if (value + 0x400000 > 0x7fffff)

    {

      if (value & 0x1)

  * errmsg = _(not_valid);

      else

  * errmsg = _(out_of_range);

    }

  else if (value & 0x1)

    * errmsg = _(not_aligned);

  return insn | ((value & 0x7e) << 4) | ((value & 0x7fff80) << (16 - 7));

}

static unsigned long

extract_d23 (unsigned long insn, int * invalid)

{

  unsigned long ret = ((insn >> 4) & 0x7f) | ((insn >> (16-7)) & 0x7fff80);

  ret = (ret ^ 0x400000) - 0x400000;

  if (invalid != 0)

    *invalid = 0;

  return ret;

}

static unsigned long

insert_i9 (unsigned long insn, unsigned long value, const char ** errmsg)

{

  if (value + 0x100 > 0x1ff)

    * errmsg = _(immediate_out_of_range);

  return insn | ((value & 0x1e0) << 13) | (value & 0x1f);

}

static unsigned long

extract_i9 (unsigned long insn, int * invalid)

{

  unsigned long ret = ((insn >> 13) & 0x1e0) | (insn & 0x1f);

  ret = (ret ^ 0x100) - 0x100;

  if (invalid != 0)

    *invalid = 0;

  return ret;

}

static unsigned long

insert_u9 (unsigned long insn, unsigned long value, const char ** errmsg)

{

  if (value > 0x1ff)

    * errmsg = _(immediate_out_of_range);

  return insn | ((value & 0x1e0) << 13) | (value & 0x1f);

}

static unsigned long

extract_u9 (unsigned long insn, int * invalid)

{

  unsigned long ret = ((insn >> 13) & 0x1e0) | (insn & 0x1f);

  if (invalid != 0)

    *invalid = 0;

  return ret;

}

static unsigned long

insert_spe (unsigned long insn, unsigned long value, const char ** errmsg)

{

  if (value != 3)

    * errmsg = _("invalid register for stack adjustment");

  return insn & ~0x180000;

}

static unsigned long

extract_spe (unsigned long insn ATTRIBUTE_UNUSED, int * invalid)

{

  if (invalid != 0)

    *invalid = 0;

  return 3;

}

static unsigned long

insert_r4 (unsigned long insn, unsigned long value, const char ** errmsg)

{

  if (value >= 32)

    * errmsg = _("invalid register name");

  return insn | ((value & 0x01) << 23) | ((value & 0x1e) << 16);

}

static unsigned long

extract_r4 (unsigned long insn, int * invalid)

{

  unsigned long r4;

  unsigned long insn2;

  insn2 = insn >> 16;

  r4 = (((insn2 & 0x0080) >> 7) | (insn2 & 0x001e));

  if (invalid != 0)

    *invalid = 0;

  return r4;

}

static unsigned long G_pos;

static unsigned long

insert_POS (unsigned long insn, unsigned long pos, const char ** errmsg)

{

  if (pos > 0x1f)

    * errmsg = _(pos_out_of_range);

  G_pos = pos;

  return insn; /* Not an oparaton until WIDTH.  */

}

static unsigned long

extract_POS_U (unsigned long insn, int * invalid)

{

  unsigned long pos,lsb;

  unsigned long insn2;

  insn2 = insn >> 16;

  lsb = ((insn2 & 0x0800) >>  8)

      | ((insn2 & 0x000e) >>  1);

  lsb += 16;

  pos = lsb;

  if (invalid != 0)

    *invalid = 0;

  return pos;

}

static unsigned long

extract_POS_L (unsigned long insn, int * invalid)

{

  unsigned long pos,lsb;

  unsigned long insn2;

  insn2 = insn >> 16;

  lsb = ((insn2 & 0x0800) >>  8)

      | ((insn2 & 0x000e) >>  1);

  pos = lsb;

  if (invalid != 0)

    *invalid = 0;

  return pos;

}

static unsigned long

insert_WIDTH (unsigned long insn, unsigned long width, const char ** errmsg)

{

  unsigned long msb, lsb, opc, ret;

  unsigned long msb_expand, lsb_expand;

  msb = width + G_pos - 1;

  lsb = G_pos;

  opc = 0;

  G_pos = 0;

  if (width > 0x20)

    * errmsg = _(width_out_of_range);

  if ((msb >= 16) && (lsb >= 16))

    opc = 0x0090;

  else if ((msb >= 16) && (lsb < 16))

    opc = 0x00b0;

  else if ((msb < 16) && (lsb < 16))

    opc = 0x00d0;

  else

    * errmsg = _(width_out_of_range);

  msb &= 0x0f;

  msb_expand = msb << 12;

  lsb &= 0x0f;

  lsb_expand = ((lsb & 0x8) << 8)|((lsb & 0x7) << 1);

  ret = (insn & 0x0000ffff) | ((opc | msb_expand | lsb_expand) << 16);

  return ret;

}

static unsigned long

extract_WIDTH_U (unsigned long insn, int * invalid)

{

  unsigned long width, msb, lsb;

  unsigned long insn2;

  insn2 = insn >> 16;

  msb = ((insn2 & 0xf000) >> 12);

  msb += 16;

  lsb = ((insn2 & 0x0800) >>  8)

      | ((insn2 & 0x000e) >>  1);

  lsb += 16;

  if (invalid != 0)

    *invalid = 0;

  width = msb - lsb + 1;

  return width;

}

static unsigned long

extract_WIDTH_M (unsigned long insn, int * invalid)

{

  unsigned long width, msb, lsb;

  unsigned long insn2;

  insn2 = insn >> 16;

  msb = ((insn2 & 0xf000) >> 12) ;

  msb += 16;

  lsb = ((insn2 & 0x0800) >>  8)

      | ((insn2 & 0x000e) >>  1);

  if (invalid != 0)

    *invalid = 0;

  width = msb - lsb + 1;

  return width;

}

static unsigned long

extract_WIDTH_L (unsigned long insn, int * invalid)

{

  unsigned long width, msb, lsb;

  unsigned long insn2;

  insn2 = insn >> 16;

  msb = ((insn2 & 0xf000) >> 12) ;

  lsb = ((insn2 & 0x0800) >>  8)

      | ((insn2 & 0x000e) >>  1);

  if (invalid != 0)

    *invalid = 0;

  width = msb - lsb + 1;

  return width;

}

static unsigned long

insert_SELID (unsigned long insn, unsigned long selid, const char ** errmsg)

{

  if (selid > 0x1f)

    * errmsg = _(selid_out_of_range);

  return insn | ((selid & 0x1fUL) << 27);

}

static unsigned long

extract_SELID (unsigned long insn, int * invalid)

{

  unsigned long selid;

  unsigned long insn2;

  insn2 = insn >> 16;

  selid = ((insn2 & 0xf800) >> 11);

  if (invalid != 0)

    *invalid = 0;

  return selid;

}

static unsigned long

insert_VECTOR8 (unsigned long insn, unsigned long vector8, const char ** errmsg)

{

  unsigned long ret;

  unsigned long VVV, vvvvv;

  if (vector8 > 0xff)

    * errmsg = _(vector8_out_of_range);

  VVV   = (vector8 & 0xe0) >> 5;

  vvvvv = (vector8 & 0x1f);

  ret = (insn | (VVV << 27) | vvvvv);

  return ret;

}

static unsigned long

extract_VECTOR8 (unsigned long insn, int * invalid)

{

  unsigned long vector8;

  unsigned long VVV,vvvvv;

  unsigned long insn2;

  insn2   = insn >> 16;

  VVV     = ((insn2 & 0x3800) >> 11);

  vvvvv   = (insn & 0x001f);

  vector8 = VVV << 5 | vvvvv;

  if (invalid != 0)

    *invalid = 0;

  return vector8;

}

static unsigned long

insert_VECTOR5 (unsigned long insn, unsigned long vector5, const char ** errmsg)

{

  unsigned long ret;

  unsigned long vvvvv;

  if (vector5 > 0x1f)

    * errmsg = _(vector5_out_of_range);

  vvvvv = (vector5 & 0x1f);

  ret = (insn | vvvvv);

  return ret;

}

static unsigned long

extract_VECTOR5 (unsigned long insn, int * invalid)

{

  unsigned long vector5;

  vector5 = (insn & 0x001f);

  if (invalid != 0)

    *invalid = 0;

  return vector5;

}

static unsigned long

insert_CACHEOP (unsigned long insn, unsigned long cacheop, const char ** errmsg ATTRIBUTE_UNUSED)

{

  unsigned long ret;

  unsigned long pp, PPPPP;

  pp    = (cacheop & 0x60) >> 5;

  PPPPP = (cacheop & 0x1f);

  ret = insn | (pp << 11) | (PPPPP << 27);

  return ret;

}

static unsigned long

extract_CACHEOP (unsigned long insn, int * invalid)

{

  unsigned long ret;

  unsigned long pp, PPPPP;

  unsigned long insn2;

  insn2 = insn >> 16;

  PPPPP = ((insn2 & 0xf800) >> 11);

  pp    = ((insn  & 0x1800) >> 11);

  ret   = (pp << 5) | PPPPP;

  if (invalid != 0)

    *invalid = 0;

  return ret;

}

static unsigned long

insert_PREFOP (unsigned long insn, unsigned long prefop, const char ** errmsg ATTRIBUTE_UNUSED)

{

  unsigned long ret;

  unsigned long PPPPP;

  PPPPP = (prefop & 0x1f);

  ret = insn | (PPPPP << 27);

  return ret;

}

static unsigned long

extract_PREFOP (unsigned long insn, int * invalid)

{

  unsigned long ret;

  unsigned long PPPPP;

  unsigned long insn2;

  insn2 = insn >> 16;

  PPPPP = (insn2 & 0xf800) >> 11;

  ret   = PPPPP;

  if (invalid != 0)

    *invalid = 0;

  return ret;

}

static unsigned long

insert_IMM10U (unsigned long insn, unsigned long value, const char ** errmsg)

{

  unsigned long imm10, ret;

  unsigned long iiiii,IIIII;

  if (value > 0x3ff)

    * errmsg = _(imm10_out_of_range);

  imm10 = value & 0x3ff;

  IIIII = (imm10 >> 5) & 0x1f;

  iiiii =  imm10       & 0x1f;

  ret = insn | IIIII << 27 | iiiii;

  return ret;

}

static unsigned long

extract_IMM10U (unsigned long insn, int * invalid)

{

  unsigned long ret;

  unsigned long iiiii,IIIII;

  unsigned long insn2;

  insn2 = insn >> 16;

  IIIII = ((insn2 & 0xf800) >> 11);

  iiiii = (insn   & 0x001f);

  ret = (IIIII << 5) | iiiii;

  if (invalid != 0)

    *invalid = 0;

  return ret;

}

static unsigned long

insert_SRSEL1 (unsigned long insn, unsigned long value, const char ** errmsg)

{

  unsigned long imm10, ret;

  unsigned long sr,selid;

  if (value > 0x3ff)

    * errmsg = _(sr_selid_out_of_range);

  imm10 = value;

  selid = (imm10 & 0x3e0) >> 5;

  sr    =  imm10 & 0x1f;

  ret   = insn | selid << 27 | sr;

  return ret;

}

static unsigned long

extract_SRSEL1 (unsigned long insn, int * invalid)

{

  unsigned long ret;

  unsigned long sr, selid;

  unsigned long insn2;

  insn2 = insn >> 16;

  selid = ((insn2 & 0xf800) >> 11);

  sr    = (insn  & 0x001f);

  ret   = (selid << 5) | sr;

  if (invalid != 0)

    *invalid = 0;

  return ret;

}

static unsigned long

insert_SRSEL2 (unsigned long insn, unsigned long value, const char ** errmsg)

{

  unsigned long imm10, ret;

  unsigned long sr, selid;

  if (value > 0x3ff)

    * errmsg = _(sr_selid_out_of_range);

  imm10 = value;

  selid = (imm10 & 0x3e0) >> 5;

  sr    =  imm10 & 0x1f;

  ret   = insn | selid << 27 | sr << 11;

  return ret;

}

static unsigned long

extract_SRSEL2 (unsigned long insn, int * invalid)

{

  unsigned long ret;

  unsigned long sr, selid;

  unsigned long insn2;

  insn2 = insn >> 16;

  selid = ((insn2 & 0xf800) >> 11);

  sr    = ((insn  & 0xf800) >> 11);

  ret   = (selid << 5) | sr;

  if (invalid != 0)

    *invalid = 0;

  return ret;

}

/* Warning: code in gas/config/tc-v850.c examines the contents of this array.

   If you change any of the values here, be sure to look for side effects in

   that code.  */

const struct v850_operand v850_operands[] =

{

#define UNUSED  0

  { 0, 0, NULL, NULL, 0, BFD_RELOC_NONE },

/* The R1 field in a format 1, 6, 7, 9, C insn.  */

#define R1  (UNUSED + 1)