VSAG/amadeus_26_fb
3
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

energy change

Browse Source
This commit is contained in:
sun
2019-07-24 22:49:14 +08:00
parent 11f7c8b469
commit 23f12425d6
2 changed files with 6 additions and 6 deletions
Download Patch File Download Diff File Expand all files Collapse all files

2
energy/include/energy/energy.h
View File

@@ -37,7 +37,7 @@ public:
void setSmallEnergyInit();//设置小能量机关初始化
void sendEnergy();//发送能量机关数据
void sendTarget(Serial& serial, float x, float y, float z);//发送数据
void sendTarget(Serial& serial, float x, float y, float z, uint16_t u);//发送数据
void sendTarget(Serial& serial, float x, float y, uint16_t z, uint16_t u);//发送数据
private:

10
energy/src/energy/send/send.cpp
View File

@@ -28,11 +28,11 @@ void Energy::sendEnergy() {
}
if (change_target) {
sendTarget(serial, yaw_rotation, pitch_rotation, 5);
sendTarget(serial, yaw_rotation, pitch_rotation, 5, 0);
} else if (is_guessing) {
sendTarget(serial, yaw_rotation, pitch_rotation, 6);
sendTarget(serial, yaw_rotation, pitch_rotation, 6, 0);
} else {
sendTarget(serial, yaw_rotation, pitch_rotation, shoot);
sendTarget(serial, yaw_rotation, pitch_rotation, shoot, 0);
}
}
@@ -77,7 +77,7 @@ void Energy::sendTarget(Serial &serial, float x, float y, float z) {
//----------------------------------------------------------------------------------------------------------------------
// 此函数用于发送数据给主控板
// ---------------------------------------------------------------------------------------------------------------------
void Energy::sendTarget(Serial &serial, float x, float y, float z, uint16_t u) {
void Energy::sendTarget(Serial &serial, float x, float y, uint16_t z, uint16_t u) {
short x_tmp, y_tmp, z_tmp;
uint8_t buff[10];
@@ -87,7 +87,7 @@ void Energy::sendTarget(Serial &serial, float x, float y, float z, uint16_t u) {
time_t t = time(nullptr);
if (last_time != t) {
last_time = t;
cout << "fps:" << fps << ", (" << x << "," << y << "," << z << ")" << endl;
cout << "fps:" << fps << ", (" << x << "," << y << "," << z << "," << u << ")" << endl;
fps = 0;
}
fps += 1;