Опять MSP430

Добрый день, помогите кто чем может опять MSP 430. Не могу доделать кнопку, кнопка должна переключать скорость двигателя (моторчика). Без кнопки все работает, на кнопку нет реакции, не пойму в чем запуталась. Порт 1.0, это точно, преподаватель подтвердил.

Дождавшись низкого сигнала включить двигатель на определённой скорости (переключение скоростей). То есть нажали один раз первая скорость, второй раз вторая скорость, третий раз и так далее


Код передатчика:

#include <msp430.h>
#define TRANSMIT 1
volatile unsigned int k;
char rec;
short handshake = 0;
//unsigned char arr [8] = {8,7,6,5,4,7,1,3};
unsigned char arr [3] = {100,175,254};
unsigned int j=0;
unsigned int t = 0;
unsigned int tdelay=1000;// Count of cycles to wait to avoid bouncing
#define BUTTON BIT5
/*
* main.c
*/
#ifdef TRANSMIT

void transmit(char c); //TX

#else

void Pwm(unsigned short duty_cycle)
{
TACCR2 = duty_cycle; // TACCR2 PWM duty cycle 128

};

unsigned int i = 0; //RX

#endif

int main(void) {
WDTCTL = WDTPW | WDTHOLD; // Stop watchdog timer

FLL_CTL0 |= XCAP14PF;
do
{
IFG1 &= ~OFIFG; // Clear OSCFault flag
for (k = 0x47FF; k > 0; k--); // Time for flag to set
}
while ((IFG1 & OFIFG)); // OSCFault flag still set?

P4SEL |= 0x03; //CHANGE

ME2 |= UTXE1 + URXE1;
U1CTL |= CHAR + PENA + SPB;
// U1CTL |= CHAR;
U1TCTL |= SSEL1;
U1BR0 = 0X1B; //57600 +
U1BR1 = 0X00; //57600
U1MCTL = 0x94; //57600
U1CTL &= ~SWRST;
IE2 |= URXIE1;

_bis_SR_register (GIE);

P1SEL &= ~BUTTON;
P1DIR &= ~BUTTON;
P1OUT &= ~BUTTON;
P1REN |= BUTTON;

P1DIR |= 0x00; // P1.1, P1.2 output
P1SEL |= 0x00;
P1SEL2 |= 0x00;


// Stop WDT
// Configure load caps

// Wait for xtal to stabilize
// P1DIR |= 0x04; // P1.2 output
//P1SEL |= 0x04; // P1.2 TA1 option
P2DIR |= 0x01; // P2.0 output
P2SEL |= 0x01; // P2.0 TA2 option
TACCR0 = 512-1;
TACCR2 = 128;
// PWM Period
//TACCTL1 = OUTMOD_7; // TACCR1 reset/set
//TACCR1 = 384; // TACCR1 PWM duty cycle
TACCTL2 = OUTMOD_7; // TACCR2 reset/set
TACTL = TASSEL_1 + MC_1; // ACLK, up mode

//_BIS_SR(LPM3_bits); // Enter LPM3

#ifdef TRANSMIT

while(1)
{
if (handshake == 0) { //TX
transmit(0x55);
_delay_cycles(1000);//TX
}
else
{
if(P3IN&BUTTON)
t++;
else
t = 0;
if (t >=tdelay)
{
transmit(arr[j]);
j++;
if (j > 2) j = 0;
t = 0;
}
}

}
}
//TX

#endif
}


#pragma vector = USART1RX_VECTOR //RX
__interrupt void USART1_rx (void) //RX
{
//RX
#ifndef TRANSMIT
while (!(IFG2 & UTXIFG1)); //RX
//TXBUF1 = RXBUF1; //RX
//TXBUF1 = 0x0f;
rec = RXBUF1; //RX
if (i == 0) { //RX
TXBUF1 = 0X0a;
i++ ;//RX
}
if(handshake == 1)
{
Pwm(RXBUF1*2);
//_delay_cycles(1000000); //TX
}
#else
if (RXBUF1 == 0X0a)
{
handshake = 1;
}//TX
#endif
//RX
}

void transmit(char c){ //TX

while (!(IFG2 & UTXIFG1)); //TX
TXBUF1 = c;
//TX

}

Код получателя:

#include <msp430.h>
//#define TRANSMIT 1
volatile unsigned int k;
char rec;
short handshake = 0;
unsigned char arr [8] = {8,7,6,5,4,7,1,3};
unsigned int j=0;
/*
* main.c
*/
#ifdef TRANSMIT

void transmit(char c); //TX

#else

void Pwm(unsigned short duty_cycle)
{
TACCR2 = duty_cycle; // TACCR2 PWM duty cycle 128
};

unsigned int i = 0; //RX

#endif

int main(void) {
WDTCTL = WDTPW | WDTHOLD; // Stop watchdog timer

FLL_CTL0 |= XCAP14PF;
do
{
IFG1 &= ~OFIFG; // Clear OSCFault flag
for (k = 0x47FF; k > 0; k--); // Time for flag to set
}
while ((IFG1 & OFIFG)); // OSCFault flag still set?

P4SEL |= 0x03; //CHANGE

ME2 |= UTXE1 + URXE1;
U1CTL |= CHAR + PENA + SPB;
// U1CTL |= CHAR;
U1TCTL |= SSEL1;
U1BR0 = 0X1B; //57600 +
U1BR1 = 0X00; //57600
U1MCTL = 0x94; //57600
U1CTL &= ~SWRST;
IE2 |= URXIE1;

_bis_SR_register (GIE);

// Stop WDT
// Configure load caps

// Wait for xtal to stabilize


// P1DIR |= 0x04; // P1.2 output
//P1SEL |= 0x04; // P1.2 TA1 option
P2DIR |= 0x01; // P2.0 output
P2SEL |= 0x01; // P2.0 TA2 option
TACCR0 = 512-1;
TACCR2 = 128;
// PWM Period
//TACCTL1 = OUTMOD_7; // TACCR1 reset/set
//TACCR1 = 384; // TACCR1 PWM duty cycle
TACCTL2 = OUTMOD_7; // TACCR2 reset/set
TACTL = TASSEL_1 + MC_1; // ACLK, up mode

//_BIS_SR(LPM3_bits); // Enter LPM3

#ifdef TRANSMIT

while(1)
{
if (handshake == 0) { //TX
transmit(0x55);
_delay_cycles(1000);//TX
}
else
{
transmit(arr[j]);
j++&0x07;//TX
}
}
//TX

#endif
}

#pragma vector = USART1RX_VECTOR //RX
__interrupt void USART1_rx (void) //RX
{
//RX
#ifndef TRANSMIT
while (!(IFG2 & UTXIFG1)); //RX
//TXBUF1 = RXBUF1; //RX
//TXBUF1 = 0x0f;
rec = RXBUF1; //RX
if (i == 0) { //RX
TXBUF1 = 0X0a;
i++ ;//RX
}
if(handshake == 1)
{
Pwm(RXBUF1*2);
}
#else
if (RXBUF1 == 0X0a)
{
handshake = 1;
}//TX
#endif

if (RXBUF1 == 0X55)
{
handshake = 1;
}
//RX
}

void transmit(char c){ //TX

while (!(IFG2 & UTXIFG1)); //TX
TXBUF1 = c;
//TX

}

0