//--------------------------------------------------------------------------------------------
// Thrust Angle
//--------------------------------------------------------------------------------------------
void Thrust_Angle() {

	char input = 0;
	unsigned int ANGLE_PW = 3250;

	lcd_clear();
	lcd_print("Select Thrust Angle:     1-9 Preset      *DECR/#INCR/0Accept");

	while(input != '0') {

		while(read_keypad() == -1) { pause(); }

		pause();

		input = read_keypad();

		pause();

		while(read_keypad() != -1) { pause(); }

		if(input == '1') {
			ANGLE_PW = 3150;
			pause();
		}

		if(input == '2') {
			ANGLE_PW = 3400;
			pause();
		}

		if(input == '3') {
			ANGLE_PW = 3750;
			pause();
		}

		if(input == '4') {
			ANGLE_PW = 3900;
			pause();
		}

		if(input == '5') {
			ANGLE_PW = 1920;
			pause();
		}

		if(input == '6') {
			ANGLE_PW = 2200;
			pause();
		}

		if(input == '7') {
			ANGLE_PW = 2550;
			pause();
		}

		if(input == '8') {
			ANGLE_PW = 2750;
			pause();
		}

		if(input == '9') {
			ANGLE_PW = 3050;
			pause();
		}

		if(input == '*') {
			ANGLE_PW -= 10;
			pause();
		}

		if(input == '#') {
			ANGLE_PW +=10;
			pause();
		}

		printf("%d\r\n", ANGLE_PW);

		PCA0CPL1 = 0xFFFF - ANGLE_PW;
		PCA0CPH1 = (0xFFFF - ANGLE_PW) >> 8;

	}
}