def task_8():
# Need to check the actual angle depending on the incline of the bucket
angleStrength = 225
mc.bucket_angle_actuator(angleStrength)
rospy.sleep(7)
mc.bucket_angle_actuator(-angleStrength)
rospy.sleep(7)
def transit_dig_test():
transit_test()
t = float(input('How long do you want to dig?'))
mc.bucket_angle_actuator(motor_pub, 60)
rospy.sleep(5)
mc.bucket_drive_motor(motor_pub, 150)
rospy.sleep(1)
mc.bucket_translation_motor(motor_pub, 780)
rospy.sleep(t)
mc.bucket_drive_motor(motor_pub, 0)
mc.bucket_translation_motor(motor_pub, 100)
rospy.sleep(2)
mc.bucket_angle_actuator(motor_pub, 15)
rospy.sleep(5)
def task_4():
driveStrength = 40
translationStrength = 10
angleStrength = 10
# Is there a way to know if it's fully angled down?
mc.bucket_angle_actuator(angleStrength)
rospy.sleep(15)
mc.bucket_angle_actuator(0)
mc.bucket_drive_motor(driveStrength)
mc.bucket_translation_motor(translationStrength)
rospy.sleep(60)
mc.bucket_drive_motor(0)
mc.bucket_translation_motor(-1 * translationStrength)
rospy.sleep(10)
mc.bucket_translation_motor(0)
mc.bucket_angle_actuator(-angleStrength)
rospy.sleep(15)
mc.bucket_angle_actuator(0)
def task_15():
angleStrength = 225
mc.bucket_angle_actuator(angleStrength)
rospy.sleep(7)
mc.bucket_angle_actuator(-angleStrength)
rospy.sleep(7)