diff --git a/src/main.cpp b/src/main.cpp
index d00e337..2475a70 100644
--- a/src/main.cpp
+++ b/src/main.cpp
@@ -20,16 +20,14 @@ int main() {
   State.vz = 0; // [m/s]
 
   // Initial YPR
-  State.yaw = 0 * M_PI / 180;   // [rad]
-  State.pitch = 0 * M_PI / 180; // [rad]
+  State.yaw = 10 * M_PI / 180;  // [rad]
+  State.pitch = 5 * M_PI / 180; // [rad]
   State.roll = 0 * M_PI / 180;  // [rad]
 
   // Initial YPRdot
-  State.yawdot = 0 * M_PI / 180;   // [rad/s]
-  State.pitchdot = 0 * M_PI / 180; // [rad/s]
-  State.rolldot =
-      0 * M_PI /
-      180; // [rad/s]    std::vector <int> vec = std::vector<int>(10);
+  State.yawdot = 1 * M_PI / 180;    // [rad/s]
+  State.pitchdot = -1 * M_PI / 180; // [rad/s]
+  State.rolldot = 0 * M_PI / 180;   // [rad/s]
 
   // Servo Limitation
   State.maxServo = 15; // [degs]