output_module.c

来自「standdard test protocol」· C语言 代码 · 共 53 行

/***************** Pin control Port RD i/p ***********************/

/*************************** IO Port Data *******************************/
int const Port_High[8]={ 0x01,0x02,0x04,0x08,0x10,0x20,0x40,0x80 };

int const Port_Low[8]={ 0xFE,0xFD,0xFB,0xF7,0xEF,0xDF,0xBF,0x7F };
/************************************************************************/

void clear_port_all( void )
{
   MemPort = OFF_ALL;
   output_d( MemPort );
}

void set_port_all( void )
{
   MemPort = ON_ALL;
   output_d( MemPort );
}

int output_control( int pin, int status )
{
   int PortDat;
   static int dat = 0xFF;
   if( SetOutput_RD )
   {
      pin = ( pin & 0x0F );
      if( pin == 0 )
      {
          MemPort = status;
          output_d( MemPort );
      }
      else if( pin > 0 && pin < 9 )
      {
         status = status & 0x0F;
         if( status == 0x01 )
         {
            PortDat =  Port_High[pin - 1];
            MemPort = MemPort | PortDat;
            output_d( MemPort );
         }
         else if( status == 0x00 )
         {
            PortDat = Port_Low[pin - 1];
            MemPort = MemPort & PortDat;
            output_d( MemPort );
         }
      }
      dat = ( status );
   }
   return( dat );
}