Repository navigation
Expand file tree
/
Copy pathdriveChassis.cpp
More file actions
73 lines (63 loc) · 2.58 KB
/
Copy pathdriveChassis.cpp
File metadata and controls
73 lines (63 loc) · 2.58 KB
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
/*----------------------------------------------------------------------------*/
/* */
/* Module: main.cpp */
/* Author: C:\Users\Rory */
/* Created: Sat Jan 11 2020 */
/* Description: V5 project */
/* */
/*----------------------------------------------------------------------------*/
// ---- START VEXCODE CONFIGURED DEVICES ----
// Robot Configuration:
// [Name] [Type] [Port(s)]
// Motor1 motor 1
// Motor2 motor 2
// Motor3 motor 3
// Motor4 motor 4
// Controller1 controller
// ---- END VEXCODE CONFIGURED DEVICES ----
#include "vex.h"
#include <iostream>
using namespace vex;
class Chassis{
public:
Chassis();
~Chassis();
void setDriveMotorVelocities(double verticalVelocity, double horizontalVelocity);
double verticalVelocities;
double horizontalVelocities;
void setDriveTurnVelocities(double rightTurnVelocity, double leftTurnVelocity);
double rightTurnVelocity;
double leftTurnVelocity;
};
Chassis::Chassis(){
Motor1.spin(forward);
Motor2.spin(forward);
Motor3.spin(forward);
Motor4.spin(forward);
}
Chassis::~Chassis(){
Brain.Screen.print("bruh\n");
}
void Chassis::setDriveMotorVelocities(double verticalVelocity, double horizontalVelocity) {
Motor1.setVelocity(verticalVelocity,rpm);
Motor2.setVelocity(verticalVelocity,rpm);
Motor3.setVelocity(horizontalVelocity,rpm);
Motor4.setVelocity(horizontalVelocity,rpm);
}
void setDriveTurnVelocities(double rightTurnVelocity, double leftTurnVelocity){
Motor1.setVelocity(-rightTurnVelocity,rpm);
Motor2.setVelocity(-rightTurnVelocity,rpm);
Motor3.setVelocity(leftTurnVelocity,rpm);
Motor4.setVelocity(leftTurnVelocity,rpm);
}
int main() {
// Initializing Robot Configuration. DO NOT REMOVE!
vexcodeInit();
Chassis drive;
while(true){
drive.verticalVelocities = Controller1.Axis3.position(percent);
drive.horizontalVelocities = Controller1.Axis4.position(percent);
drive.rightTurnVelocity = Controller1.Axis1.position(percent);
drive.setDriveMotorVelocities(drive.verticalVelocities, drive.horizontalVelocities);
}
}