Subversion Repositories openmsp430

//----------------------------------------------------------------------------

// Copyright (C) 2009 , Olivier Girard

//

// Redistribution and use in source and binary forms, with or without

// modification, are permitted provided that the following conditions

// are met:

//     * Redistributions of source code must retain the above copyright

//       notice, this list of conditions and the following disclaimer.

//     * Redistributions in binary form must reproduce the above copyright

//       notice, this list of conditions and the following disclaimer in the

//       documentation and/or other materials provided with the distribution.

//     * Neither the name of the authors nor the names of its contributors

//       may be used to endorse or promote products derived from this software

//       without specific prior written permission.

//

// THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"

// AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE

// IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE

// ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE

// LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY,

// OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF

// SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS

// INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN

// CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)

// ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF

// THE POSSIBILITY OF SUCH DAMAGE

//

//----------------------------------------------------------------------------

//

// *File Name: omsp_gpio.v

// 

// *Module Description:

//                       Digital I/O interface

//

// *Author(s):

//              - Olivier Girard,    olgirard@gmail.com

//

//----------------------------------------------------------------------------

// $Rev: 103 $

// $LastChangedBy: olivier.girard $

// $LastChangedDate: 2011-03-05 15:44:48 +0100 (Sat, 05 Mar 2011) $

//----------------------------------------------------------------------------

module  omsp_gpio (

// OUTPUTs

    irq_port1,                      // Port 1 interrupt

    irq_port2,                      // Port 2 interrupt

    p1_dout,                        // Port 1 data output

    p1_dout_en,                     // Port 1 data output enable

    p1_sel,                         // Port 1 function select

    p2_dout,                        // Port 2 data output

    p2_dout_en,                     // Port 2 data output enable

    p2_sel,                         // Port 2 function select

    p3_dout,                        // Port 3 data output

    p3_dout_en,                     // Port 3 data output enable

    p3_sel,                         // Port 3 function select

    p4_dout,                        // Port 4 data output

    p4_dout_en,                     // Port 4 data output enable

    p4_sel,                         // Port 4 function select

    p5_dout,                        // Port 5 data output

    p5_dout_en,                     // Port 5 data output enable

    p5_sel,                         // Port 5 function select

    p6_dout,                        // Port 6 data output

    p6_dout_en,                     // Port 6 data output enable

    p6_sel,                         // Port 6 function select

    per_dout,                       // Peripheral data output

// INPUTs

    mclk,                           // Main system clock

    p1_din,                         // Port 1 data input

    p2_din,                         // Port 2 data input

    p3_din,                         // Port 3 data input

    p4_din,                         // Port 4 data input

    p5_din,                         // Port 5 data input

    p6_din,                         // Port 6 data input

    per_addr,                       // Peripheral address

    per_din,                        // Peripheral data input

    per_en,                         // Peripheral enable (high active)

    per_we,                         // Peripheral write enable (high active)

    puc_rst                         // Main system reset

);

// PARAMETERs

//============

parameter           P1_EN = 1'b1;   // Enable Port 1

parameter           P2_EN = 1'b1;   // Enable Port 2

parameter           P3_EN = 1'b0;   // Enable Port 3

parameter           P4_EN = 1'b0;   // Enable Port 4

parameter           P5_EN = 1'b0;   // Enable Port 5

parameter           P6_EN = 1'b0;   // Enable Port 6

// OUTPUTs

//=========

output              irq_port1;      // Port 1 interrupt

output              irq_port2;      // Port 2 interrupt

output        [7:0] p1_dout;        // Port 1 data output

output        [7:0] p1_dout_en;     // Port 1 data output enable

output        [7:0] p1_sel;         // Port 1 function select

output        [7:0] p2_dout;        // Port 2 data output

output        [7:0] p2_dout_en;     // Port 2 data output enable

output        [7:0] p2_sel;         // Port 2 function select

output        [7:0] p3_dout;        // Port 3 data output

output        [7:0] p3_dout_en;     // Port 3 data output enable

output        [7:0] p3_sel;         // Port 3 function select

output        [7:0] p4_dout;        // Port 4 data output

output        [7:0] p4_dout_en;     // Port 4 data output enable

output        [7:0] p4_sel;         // Port 4 function select

output        [7:0] p5_dout;        // Port 5 data output

output        [7:0] p5_dout_en;     // Port 5 data output enable

output        [7:0] p5_sel;         // Port 5 function select

output        [7:0] p6_dout;        // Port 6 data output

output        [7:0] p6_dout_en;     // Port 6 data output enable

output        [7:0] p6_sel;         // Port 6 function select

output       [15:0] per_dout;       // Peripheral data output

// INPUTs

//=========

input               mclk;           // Main system clock

input         [7:0] p1_din;         // Port 1 data input

input         [7:0] p2_din;         // Port 2 data input

input         [7:0] p3_din;         // Port 3 data input

input         [7:0] p4_din;         // Port 4 data input

input         [7:0] p5_din;         // Port 5 data input

input         [7:0] p6_din;         // Port 6 data input

input        [13:0] per_addr;       // Peripheral address

input        [15:0] per_din;        // Peripheral data input

input               per_en;         // Peripheral enable (high active)

input         [1:0] per_we;         // Peripheral write enable (high active)

input               puc_rst;        // Main system reset

//=============================================================================

// 1)  PARAMETER DECLARATION

//=============================================================================

// Masks

parameter              P1_EN_MSK   = {8{P1_EN[0]}};

parameter              P2_EN_MSK   = {8{P2_EN[0]}};

parameter              P3_EN_MSK   = {8{P3_EN[0]}};

parameter              P4_EN_MSK   = {8{P4_EN[0]}};

parameter              P5_EN_MSK   = {8{P5_EN[0]}};

parameter              P6_EN_MSK   = {8{P6_EN[0]}};

// Register base address (must be aligned to decoder bit width)

parameter       [14:0] BASE_ADDR   = 15'h0000;

// Decoder bit width (defines how many bits are considered for address decoding)

parameter              DEC_WD      =  6;

// Register addresses offset

parameter [DEC_WD-1:0] P1IN        = 'h20,                    // Port 1

                       P1OUT       = 'h21,

                       P1DIR       = 'h22,

                       P1IFG       = 'h23,

                       P1IES       = 'h24,

                       P1IE        = 'h25,

                       P1SEL       = 'h26,

                       P2IN        = 'h28,                    // Port 2

                       P2OUT       = 'h29,

                       P2DIR       = 'h2A,

                       P2IFG       = 'h2B,

                       P2IES       = 'h2C,

                       P2IE        = 'h2D,

                       P2SEL       = 'h2E,

                       P3IN        = 'h18,                    // Port 3

                       P3OUT       = 'h19,

                       P3DIR       = 'h1A,

                       P3SEL       = 'h1B,

                       P4IN        = 'h1C,                    // Port 4

                       P4OUT       = 'h1D,

                       P4DIR       = 'h1E,

                       P4SEL       = 'h1F,

                       P5IN        = 'h30,                    // Port 5

                       P5OUT       = 'h31,

                       P5DIR       = 'h32,

                       P5SEL       = 'h33,

                       P6IN        = 'h34,                    // Port 6

                       P6OUT       = 'h35,

                       P6DIR       = 'h36,

                       P6SEL       = 'h37;

// Register one-hot decoder utilities

parameter              DEC_SZ      =  (1 << DEC_WD);

parameter [DEC_SZ-1:0] BASE_REG    =  {{DEC_SZ-1{1'b0}}, 1'b1};

// Register one-hot decoder

parameter [DEC_SZ-1:0] P1IN_D      =  (BASE_REG << P1IN),     // Port 1

                       P1OUT_D     =  (BASE_REG << P1OUT),

                       P1DIR_D     =  (BASE_REG << P1DIR),

                       P1IFG_D     =  (BASE_REG << P1IFG),

                       P1IES_D     =  (BASE_REG << P1IES),

                       P1IE_D      =  (BASE_REG << P1IE),

                       P1SEL_D     =  (BASE_REG << P1SEL),

                       P2IN_D      =  (BASE_REG << P2IN),     // Port 2

                       P2OUT_D     =  (BASE_REG << P2OUT),

                       P2DIR_D     =  (BASE_REG << P2DIR),

                       P2IFG_D     =  (BASE_REG << P2IFG),

                       P2IES_D     =  (BASE_REG << P2IES),

                       P2IE_D      =  (BASE_REG << P2IE),

                       P2SEL_D     =  (BASE_REG << P2SEL),

                       P3IN_D      =  (BASE_REG << P3IN),     // Port 3

                       P3OUT_D     =  (BASE_REG << P3OUT),

                       P3DIR_D     =  (BASE_REG << P3DIR),

                       P3SEL_D     =  (BASE_REG << P3SEL),

                       P4IN_D      =  (BASE_REG << P4IN),     // Port 4

                       P4OUT_D     =  (BASE_REG << P4OUT),

                       P4DIR_D     =  (BASE_REG << P4DIR),

                       P4SEL_D     =  (BASE_REG << P4SEL),

                       P5IN_D      =  (BASE_REG << P5IN),     // Port 5

                       P5OUT_D     =  (BASE_REG << P5OUT),

                       P5DIR_D     =  (BASE_REG << P5DIR),

                       P5SEL_D     =  (BASE_REG << P5SEL),

                       P6IN_D      =  (BASE_REG << P6IN),     // Port 6

                       P6OUT_D     =  (BASE_REG << P6OUT),

                       P6DIR_D     =  (BASE_REG << P6DIR),

                       P6SEL_D     =  (BASE_REG << P6SEL);

//============================================================================

// 2)  REGISTER DECODER

//============================================================================

// Local register selection

wire              reg_sel      =  per_en & (per_addr[13:DEC_WD-1]==BASE_ADDR[14:DEC_WD]);

// Register local address

wire [DEC_WD-1:0] reg_addr     =  {1'b0, per_addr[DEC_WD-2:0]};

// Register address decode

wire [DEC_SZ-1:0] reg_dec      =  (P1IN_D   &  {DEC_SZ{(reg_addr==(P1IN  >>1))  &  P1_EN[0]}})  |

                                  (P1OUT_D  &  {DEC_SZ{(reg_addr==(P1OUT >>1))  &  P1_EN[0]}})  |

                                  (P1DIR_D  &  {DEC_SZ{(reg_addr==(P1DIR >>1))  &  P1_EN[0]}})  |

                                  (P1IFG_D  &  {DEC_SZ{(reg_addr==(P1IFG >>1))  &  P1_EN[0]}})  |

                                  (P1IES_D  &  {DEC_SZ{(reg_addr==(P1IES >>1))  &  P1_EN[0]}})  |

                                  (P1IE_D   &  {DEC_SZ{(reg_addr==(P1IE  >>1))  &  P1_EN[0]}})  |

                                  (P1SEL_D  &  {DEC_SZ{(reg_addr==(P1SEL >>1))  &  P1_EN[0]}})  |

                                  (P2IN_D   &  {DEC_SZ{(reg_addr==(P2IN  >>1))  &  P2_EN[0]}})  |

                                  (P2OUT_D  &  {DEC_SZ{(reg_addr==(P2OUT >>1))  &  P2_EN[0]}})  |

                                  (P2DIR_D  &  {DEC_SZ{(reg_addr==(P2DIR >>1))  &  P2_EN[0]}})  |

                                  (P2IFG_D  &  {DEC_SZ{(reg_addr==(P2IFG >>1))  &  P2_EN[0]}})  |

                                  (P2IES_D  &  {DEC_SZ{(reg_addr==(P2IES >>1))  &  P2_EN[0]}})  |

                                  (P2IE_D   &  {DEC_SZ{(reg_addr==(P2IE  >>1))  &  P2_EN[0]}})  |

                                  (P2SEL_D  &  {DEC_SZ{(reg_addr==(P2SEL >>1))  &  P2_EN[0]}})  |

                                  (P3IN_D   &  {DEC_SZ{(reg_addr==(P3IN  >>1))  &  P3_EN[0]}})  |

                                  (P3OUT_D  &  {DEC_SZ{(reg_addr==(P3OUT >>1))  &  P3_EN[0]}})  |

                                  (P3DIR_D  &  {DEC_SZ{(reg_addr==(P3DIR >>1))  &  P3_EN[0]}})  |

                                  (P3SEL_D  &  {DEC_SZ{(reg_addr==(P3SEL >>1))  &  P3_EN[0]}})  |

                                  (P4IN_D   &  {DEC_SZ{(reg_addr==(P4IN  >>1))  &  P4_EN[0]}})  |

                                  (P4OUT_D  &  {DEC_SZ{(reg_addr==(P4OUT >>1))  &  P4_EN[0]}})  |

                                  (P4DIR_D  &  {DEC_SZ{(reg_addr==(P4DIR >>1))  &  P4_EN[0]}})  |

                                  (P4SEL_D  &  {DEC_SZ{(reg_addr==(P4SEL >>1))  &  P4_EN[0]}})  |

                                  (P5IN_D   &  {DEC_SZ{(reg_addr==(P5IN  >>1))  &  P5_EN[0]}})  |

                                  (P5OUT_D  &  {DEC_SZ{(reg_addr==(P5OUT >>1))  &  P5_EN[0]}})  |

                                  (P5DIR_D  &  {DEC_SZ{(reg_addr==(P5DIR >>1))  &  P5_EN[0]}})  |

                                  (P5SEL_D  &  {DEC_SZ{(reg_addr==(P5SEL >>1))  &  P5_EN[0]}})  |

                                  (P6IN_D   &  {DEC_SZ{(reg_addr==(P6IN  >>1))  &  P6_EN[0]}})  |

                                  (P6OUT_D  &  {DEC_SZ{(reg_addr==(P6OUT >>1))  &  P6_EN[0]}})  |

                                  (P6DIR_D  &  {DEC_SZ{(reg_addr==(P6DIR >>1))  &  P6_EN[0]}})  |

                                  (P6SEL_D  &  {DEC_SZ{(reg_addr==(P6SEL >>1))  &  P6_EN[0]}});

// Read/Write probes

wire              reg_lo_write =  per_we[0] & reg_sel;

wire              reg_hi_write =  per_we[1] & reg_sel;

wire              reg_read     = ~|per_we   & reg_sel;

// Read/Write vectors

wire [DEC_SZ-1:0] reg_hi_wr    = reg_dec & {DEC_SZ{reg_hi_write}};

wire [DEC_SZ-1:0] reg_lo_wr    = reg_dec & {DEC_SZ{reg_lo_write}};

wire [DEC_SZ-1:0] reg_rd       = reg_dec & {DEC_SZ{reg_read}};

//============================================================================

// 3) REGISTERS

//============================================================================

// P1IN Register

//---------------

wire [7:0] p1in;

omsp_sync_cell sync_cell_p1in_0 (.data_out(p1in[0]), .data_in(p1_din[0] & P1_EN[0]), .clk(mclk), .rst(puc_rst));

omsp_sync_cell sync_cell_p1in_1 (.data_out(p1in[1]), .data_in(p1_din[1] & P1_EN[0]), .clk(mclk), .rst(puc_rst));

omsp_sync_cell sync_cell_p1in_2 (.data_out(p1in[2]), .data_in(p1_din[2] & P1_EN[0]), .clk(mclk), .rst(puc_rst));

omsp_sync_cell sync_cell_p1in_3 (.data_out(p1in[3]), .data_in(p1_din[3] & P1_EN[0]), .clk(mclk), .rst(puc_rst));

omsp_sync_cell sync_cell_p1in_4 (.data_out(p1in[4]), .data_in(p1_din[4] & P1_EN[0]), .clk(mclk), .rst(puc_rst));

omsp_sync_cell sync_cell_p1in_5 (.data_out(p1in[5]), .data_in(p1_din[5] & P1_EN[0]), .clk(mclk), .rst(puc_rst));

omsp_sync_cell sync_cell_p1in_6 (.data_out(p1in[6]), .data_in(p1_din[6] & P1_EN[0]), .clk(mclk), .rst(puc_rst));

omsp_sync_cell sync_cell_p1in_7 (.data_out(p1in[7]), .data_in(p1_din[7] & P1_EN[0]), .clk(mclk), .rst(puc_rst));

// P1OUT Register

//----------------

reg  [7:0] p1out;

wire       p1out_wr  = P1OUT[0] ? reg_hi_wr[P1OUT] : reg_lo_wr[P1OUT];

wire [7:0] p1out_nxt = P1OUT[0] ? per_din[15:8]    : per_din[7:0];

always @ (posedge mclk or posedge puc_rst)

  if (puc_rst)        p1out <=  8'h00;

  else if (p1out_wr)  p1out <=  p1out_nxt & P1_EN_MSK;

assign p1_dout = p1out;

// P1DIR Register

//----------------

reg  [7:0] p1dir;

wire       p1dir_wr  = P1DIR[0] ? reg_hi_wr[P1DIR] : reg_lo_wr[P1DIR];

wire [7:0] p1dir_nxt = P1DIR[0] ? per_din[15:8]    : per_din[7:0];

always @ (posedge mclk or posedge puc_rst)

  if (puc_rst)        p1dir <=  8'h00;

  else if (p1dir_wr)  p1dir <=  p1dir_nxt & P1_EN_MSK;

assign p1_dout_en = p1dir;

// P1IFG Register

//----------------

reg  [7:0] p1ifg;

wire       p1ifg_wr  = P1IFG[0] ? reg_hi_wr[P1IFG] : reg_lo_wr[P1IFG];

wire [7:0] p1ifg_nxt = P1IFG[0] ? per_din[15:8]    : per_din[7:0];

wire [7:0] p1ifg_set;

always @ (posedge mclk or posedge puc_rst)

  if (puc_rst)        p1ifg <=  8'h00;

  else if (p1ifg_wr)  p1ifg <=  (p1ifg_nxt | p1ifg_set) & P1_EN_MSK;

  else                p1ifg <=  (p1ifg     | p1ifg_set) & P1_EN_MSK;

// P1IES Register

//----------------

reg  [7:0] p1ies;

wire       p1ies_wr  = P1IES[0] ? reg_hi_wr[P1IES] : reg_lo_wr[P1IES];

wire [7:0] p1ies_nxt = P1IES[0] ? per_din[15:8]    : per_din[7:0];

always @ (posedge mclk or posedge puc_rst)

  if (puc_rst)        p1ies <=  8'h00;

  else if (p1ies_wr)  p1ies <=  p1ies_nxt & P1_EN_MSK;

// P1IE Register

//----------------

reg  [7:0] p1ie;

wire       p1ie_wr  = P1IE[0] ? reg_hi_wr[P1IE] : reg_lo_wr[P1IE];

wire [7:0] p1ie_nxt = P1IE[0] ? per_din[15:8]   : per_din[7:0];

always @ (posedge mclk or posedge puc_rst)

  if (puc_rst)       p1ie <=  8'h00;

  else if (p1ie_wr)  p1ie <=  p1ie_nxt & P1_EN_MSK;

// P1SEL Register

//----------------

reg  [7:0] p1sel;

wire       p1sel_wr  = P1SEL[0] ? reg_hi_wr[P1SEL] : reg_lo_wr[P1SEL];

wire [7:0] p1sel_nxt = P1SEL[0] ? per_din[15:8]    : per_din[7:0];

always @ (posedge mclk or posedge puc_rst)

  if (puc_rst)       p1sel <=  8'h00;

  else if (p1sel_wr) p1sel <=  p1sel_nxt & P1_EN_MSK;

assign p1_sel = p1sel;

// P2IN Register

//---------------

wire [7:0] p2in;

omsp_sync_cell sync_cell_p2in_0 (.data_out(p2in[0]), .data_in(p2_din[0] & P2_EN[0]), .clk(mclk), .rst(puc_rst));

omsp_sync_cell sync_cell_p2in_1 (.data_out(p2in[1]), .data_in(p2_din[1] & P2_EN[0]), .clk(mclk), .rst(puc_rst));

omsp_sync_cell sync_cell_p2in_2 (.data_out(p2in[2]), .data_in(p2_din[2] & P2_EN[0]), .clk(mclk), .rst(puc_rst));

omsp_sync_cell sync_cell_p2in_3 (.data_out(p2in[3]), .data_in(p2_din[3] & P2_EN[0]), .clk(mclk), .rst(puc_rst));

omsp_sync_cell sync_cell_p2in_4 (.data_out(p2in[4]), .data_in(p2_din[4] & P2_EN[0]), .clk(mclk), .rst(puc_rst));

omsp_sync_cell sync_cell_p2in_5 (.data_out(p2in[5]), .data_in(p2_din[5] & P2_EN[0]), .clk(mclk), .rst(puc_rst));

omsp_sync_cell sync_cell_p2in_6 (.data_out(p2in[6]), .data_in(p2_din[6] & P2_EN[0]), .clk(mclk), .rst(puc_rst));

omsp_sync_cell sync_cell_p2in_7 (.data_out(p2in[7]), .data_in(p2_din[7] & P2_EN[0]), .clk(mclk), .rst(puc_rst));

// P2OUT Register

//----------------

reg  [7:0] p2out;

wire       p2out_wr  = P2OUT[0] ? reg_hi_wr[P2OUT] : reg_lo_wr[P2OUT];

wire [7:0] p2out_nxt = P2OUT[0] ? per_din[15:8]    : per_din[7:0];

always @ (posedge mclk or posedge puc_rst)

  if (puc_rst)        p2out <=  8'h00;

  else if (p2out_wr)  p2out <=  p2out_nxt & P2_EN_MSK;

assign p2_dout = p2out;

// P2DIR Register

//----------------

reg  [7:0] p2dir;

wire       p2dir_wr  = P2DIR[0] ? reg_hi_wr[P2DIR] : reg_lo_wr[P2DIR];

wire [7:0] p2dir_nxt = P2DIR[0] ? per_din[15:8]    : per_din[7:0];

always @ (posedge mclk or posedge puc_rst)

  if (puc_rst)        p2dir <=  8'h00;

  else if (p2dir_wr)  p2dir <=  p2dir_nxt & P2_EN_MSK;

assign p2_dout_en = p2dir;

// P2IFG Register

//----------------

reg  [7:0] p2ifg;

wire       p2ifg_wr  = P2IFG[0] ? reg_hi_wr[P2IFG] : reg_lo_wr[P2IFG];

wire [7:0] p2ifg_nxt = P2IFG[0] ? per_din[15:8]    : per_din[7:0];

wire [7:0] p2ifg_set;

always @ (posedge mclk or posedge puc_rst)

  if (puc_rst)        p2ifg <=  8'h00;

  else if (p2ifg_wr)  p2ifg <=  (p2ifg_nxt | p2ifg_set) & P2_EN_MSK;

  else                p2ifg <=  (p2ifg     | p2ifg_set) & P2_EN_MSK;

// P2IES Register

//----------------

reg  [7:0] p2ies;

wire       p2ies_wr  = P2IES[0] ? reg_hi_wr[P2IES] : reg_lo_wr[P2IES];

wire [7:0] p2ies_nxt = P2IES[0] ? per_din[15:8]    : per_din[7:0];

always @ (posedge mclk or posedge puc_rst)

  if (puc_rst)        p2ies <=  8'h00;

  else if (p2ies_wr)  p2ies <=  p2ies_nxt & P2_EN_MSK;

// P2IE Register

//----------------

reg  [7:0] p2ie;

wire       p2ie_wr  = P2IE[0] ? reg_hi_wr[P2IE] : reg_lo_wr[P2IE];

wire [7:0] p2ie_nxt = P2IE[0] ? per_din[15:8]   : per_din[7:0];

always @ (posedge mclk or posedge puc_rst)

  if (puc_rst)       p2ie <=  8'h00;

  else if (p2ie_wr)  p2ie <=  p2ie_nxt & P2_EN_MSK;

// P2SEL Register

//----------------

reg  [7:0] p2sel;

wire       p2sel_wr  = P2SEL[0] ? reg_hi_wr[P2SEL] : reg_lo_wr[P2SEL];

wire [7:0] p2sel_nxt = P2SEL[0] ? per_din[15:8]    : per_din[7:0];

always @ (posedge mclk or posedge puc_rst)

  if (puc_rst)       p2sel <=  8'h00;

  else if (p2sel_wr) p2sel <=  p2sel_nxt & P2_EN_MSK;

assign p2_sel = p2sel;

// P3IN Register

//---------------

wire  [7:0] p3in;

omsp_sync_cell sync_cell_p3in_0 (.data_out(p3in[0]), .data_in(p3_din[0] & P3_EN[0]), .clk(mclk), .rst(puc_rst));

omsp_sync_cell sync_cell_p3in_1 (.data_out(p3in[1]), .data_in(p3_din[1] & P3_EN[0]), .clk(mclk), .rst(puc_rst));

omsp_sync_cell sync_cell_p3in_2 (.data_out(p3in[2]), .data_in(p3_din[2] & P3_EN[0]), .clk(mclk), .rst(puc_rst));

omsp_sync_cell sync_cell_p3in_3 (.data_out(p3in[3]), .data_in(p3_din[3] & P3_EN[0]), .clk(mclk), .rst(puc_rst));

omsp_sync_cell sync_cell_p3in_4 (.data_out(p3in[4]), .data_in(p3_din[4] & P3_EN[0]), .clk(mclk), .rst(puc_rst));

omsp_sync_cell sync_cell_p3in_5 (.data_out(p3in[5]), .data_in(p3_din[5] & P3_EN[0]), .clk(mclk), .rst(puc_rst));

omsp_sync_cell sync_cell_p3in_6 (.data_out(p3in[6]), .data_in(p3_din[6] & P3_EN[0]), .clk(mclk), .rst(puc_rst));

omsp_sync_cell sync_cell_p3in_7 (.data_out(p3in[7]), .data_in(p3_din[7] & P3_EN[0]), .clk(mclk), .rst(puc_rst));

// P3OUT Register

//----------------

reg  [7:0] p3out;

wire       p3out_wr  = P3OUT[0] ? reg_hi_wr[P3OUT] : reg_lo_wr[P3OUT];

wire [7:0] p3out_nxt = P3OUT[0] ? per_din[15:8]    : per_din[7:0];

always @ (posedge mclk or posedge puc_rst)

  if (puc_rst)        p3out <=  8'h00;

  else if (p3out_wr)  p3out <=  p3out_nxt & P3_EN_MSK;

assign p3_dout = p3out;

// P3DIR Register

//----------------

reg  [7:0] p3dir;

wire       p3dir_wr  = P3DIR[0] ? reg_hi_wr[P3DIR] : reg_lo_wr[P3DIR];

wire [7:0] p3dir_nxt = P3DIR[0] ? per_din[15:8]    : per_din[7:0];

always @ (posedge mclk or posedge puc_rst)

  if (puc_rst)        p3dir <=  8'h00;

  else if (p3dir_wr)  p3dir <=  p3dir_nxt & P3_EN_MSK;

assign p3_dout_en = p3dir;

// P3SEL Register

//----------------