• View
• Edit
• History
• Print

HuntMurphyPickDrop

// manipulate the ball
void pickdrop (void)

	{
	 cr8_adc_enable(ADC_CENTER_1);
	 cr8_adc_enable(ADC_CENTER_2);
	 cr8_adc_enable(ADC_LEFT_1);
	 cr8_update(cr8);
         if((safe) && (intime))
		{
		 cr8_update(cr8);
		 cr8_drive(0, 0);
		 cr8_cricket_servo_set(0, 0);
		 cr8_delay(1000);
		 cr8_cricket_servo_set(1, 0);
		 cr8_delay(1000);
		 cr8_cricket_servo_set(0, 255);
		 cr8_delay(1000);
		 cr8_update(cr8);
		 if(cr8->adc_left2 != color)
			{
			 cr8_cricket_servo_set(0, 255);
			 cr8_delay(1000);
			 cr8_cricket_servo_set(7, 0);
			 cr8_delay(1000);
			 cr8_cricket_servo_set(0, 127);
			 cr8_delay(1000);
			}
		 return;
		}
	 if((!safe) && (intime))
		{
		 cr8_update(cr8);
		 cr8_drive(0, 0);
		 cr8_cricket_servo_set(0, 0);
		 cr8_delay(1000);
		 cr8_cricket_servo_set(1, 255);
		 cr8_delay(1000);
		 cr8_cricket_servo_set(0, 255);
		 cr8_delay(1000);
		 cr8_drive(-250, 250);
		 cr8_delay(250);
		 cr8_drive(100,100);
		 cr8_update(cr8);
		}
	 return;
	}