redrey.c

来自「使用MC9S12DG128芯片」· C语言 代码 · 共 96 行

//
#include "includes.h"

INT8U Hwsam(void)
{
  INT8U Hwrd;
  
  INT8S Hwcode;
  
  DDRH  = 0x0f;
  
  _NOP_;
  
  _NOP_;
  
  Hwrd  = PTIH;
  
  Hwrd  = Hwrd & 0b01100000;  //onle connect two redray;
  
  switch(Hwrd)
  {
    case 0b10000000:
    
      Hwcode  = -6;         
      
      Servo2deg(-2000);
      
      break;
      
    case 0b11000000:
    
      Hwcode  = -4;
      
      Servo2deg(-1000);
      
      break;
      
    case 0b01000000:
    
      Hwcode  = -2;
      
      Servo2deg(-250);
      
      break;
      
    case 0b01100000:
    
      Hwcode  = 0;
      
      Servo2deg(0);
      
      break;
      
    case 0b00100000:
    
      Hwcode  = 2;
      
      Servo2deg(250);
      
      break;
      
    case 0b00110000:
    
      Hwcode  = 4;
      
      Servo2deg(1000);
      
      break;
      
    case 0b00010000:
    
      Hwcode  = 6;
      
      Servo2deg(2000);
      
      break;
      
    case 0b00000000:
    
      Hwcode  = 50;
      
      StopMoto();
      
      break;
      
    default:
    
      Hwcode  = 127;
  }
  
    return (Hwcode);
  
}
  

/////////////////////////////////////////////////////////////////////////