-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy patharcade_drive.c
24 lines (21 loc) · 1004 Bytes
/
arcade_drive.c
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
#pragma config(Hubs, S1, HTServo, HTMotor, none, none)
#pragma config(Sensor, S1, , sensorI2CMuxController)
#pragma config(Motor, mtr_S1_C2_1, left_drive, tmotorTetrix, openLoop, reversed)
#pragma config(Motor, mtr_S1_C2_2, right_drive, tmotorTetrix, openLoop)
#pragma config(Servo, srvo_S1_C1_1, servo1, tServoNone)
#pragma config(Servo, srvo_S1_C1_2, servo2, tServoNone)
#pragma config(Servo, srvo_S1_C1_3, servo3, tServoNone)
#pragma config(Servo, srvo_S1_C1_4, servo4, tServoNone)
#pragma config(Servo, srvo_S1_C1_5, servo5, tServoNone)
#pragma config(Servo, srvo_S1_C1_6, servo6, tServoNone)
//*!!Code automatically generated by 'ROBOTC' configuration wizard !!*//
#include "gearcats_helpers.h"
void init() {
left_drive_motor = left_drive;
right_drive_motor = right_drive;
}
task main()
{
drive_forwards(2000);
turn_left(1000);
}