整理代码，添加部分注释

others/include/additions/additions.h

@@ -7,15 +7,6 @@
 
 #include <stdint.h>
 #include <serial/serial.h>
-#include <opencv2/videoio.hpp>
-#include <camera/wrapper_head.h>
-
-#define ENEMY_BLUE 0
-#define ENEMY_RED  1
-
-#define BIG_ENERGY_STATE 'b'
-#define SMALL_ENERGY_STATE 's'
-#define ARMOR_STATE  'a'
 
 struct mcu_data{
     float curr_yaw;

others/include/constants.h

@@ -0,0 +1,17 @@
+//
+// Created by xinyang on 19-7-8.
+//
+
+#ifndef _CONSTANTS_H_
+#define _CONSTANTS_H_
+
+#define PI (3.14159265459)
+
+#define ENEMY_BLUE 0
+#define ENEMY_RED  1
+
+#define BIG_ENERGY_STATE   'b'
+#define SMALL_ENERGY_STATE 's'
+#define ARMOR_STATE        'a'
+
+#endif /* _CONSTANTS_H */

others/src/additions/additions.cpp

@@ -3,17 +3,17 @@
 //
 
 #include <cstring>
+#include <iostream>
 #include <fstream>
 #include <opencv2/core/core.hpp>
 #include <opencv2/highgui/highgui.hpp>
 #include <opencv2/imgproc/imgproc.hpp>
+#include <opencv2/videoio/videoio_c.h>
 #include <additions/additions.h>
 #include <camera/camera_wrapper.h>
-#include <log.h>
-#include <opencv2/videoio/videoio_c.h>
-#include <iostream>
 #include <energy/energy.h>
 #include <armor_finder/armor_finder.h>
+#include <log.h>
 
 #define RECEIVE_LOG_LEVEL LOG_MSG