@@ -38,19 +38,13 @@ using namespace frc;
38
38
using namespace cv ;
39
39
using namespace cs ;
40
40
41
- class ImageProcess : public frc ::TimedRobot {
42
- void makeGrid (Mat img, int cellSize);
43
- Mat makeGrid (char *fileName, char *result);
44
- void RobotInit ();
45
- string getPutTextData (int count);
46
- };
47
-
48
41
class Robot : public frc ::TimedRobot {
49
- double acceleration (double input) {
42
+ /* double acceleration (double input) {
50
43
double V;
51
- V = input / 2 * sin (((( 2 * M_PI) / f ) * timer.Get () - M_PI_2) + input / 2 ) ;
44
+ V = input / 2 * sin(((2 * M_PI) / 6 ) * timer.Get() - M_PI_2) + input / 2;
52
45
return V;
53
- }
46
+ }*/
47
+
54
48
public:
55
49
void RobotInit () override ;
56
50
void RobotPeriodic () override ;
@@ -61,23 +55,9 @@ class Robot : public frc::TimedRobot {
61
55
void TestPeriodic () override ;
62
56
63
57
private:
64
- static constexpr double turningSpeedFast = .7 ;
65
- static constexpr double turningSpeedSlow = .5 ;
66
- static constexpr double speedFast = 1 ;
67
- static constexpr double speedNormal = .7 ;
68
- static constexpr double speedSlow = .5 ;
69
- static constexpr double stall = -.2 ;
70
- static constexpr double upSpeedNormal = -.4 ;
71
- static constexpr double upSpeedFast = -.5 ;
72
- static constexpr double downSpeedNormal = -.04 ;
73
- static constexpr double downSpeedFast = -.03 ;
74
- static constexpr double flywheelIntake = .5 ;
75
- static constexpr double flywheelOutake = .5 ;
76
- static constexpr double f = 10 ;// Frequancy for acceleration
77
- // Analog PI (PWM)
78
58
AnalogInput pi{0 };
79
- Joystick fightStick{1 };
80
- Joystick flightStick{2 };
59
+ Joystick fightStick{2 };
60
+ Joystick flightStick{1 };
81
61
Compressor compressor;
82
62
Timer timer;
83
63
PWMVictorSPX m_frontLeft{0 };
0 commit comments