yemai/bizhang_-obav
1
0
Fork 0
mirror of https://gitee.com/xiaohuolufeihua/bizhang_-obav.git synced 2026-05-22 01:12:31 +00:00
Code Issues Packages Projects Releases Wiki Activity

Fixed automatic log conversion / plotting script

Browse Source
This commit is contained in:
Lorenz Meier
2012-10-25 18:53:03 +02:00
parent c71f2ea204
commit 5f01688490
2 changed files with 21 additions and 5 deletions
Download Patch File Download Diff File Expand all files Collapse all files

16
ROMFS/logging/logconv.m
View File

@@ -1,5 +1,5 @@
clear all clear all
clc close all
%%%%%%%%%%%%%%%%%%%%%%% %%%%%%%%%%%%%%%%%%%%%%%
% SYSTEM VECTOR % SYSTEM VECTOR
@@ -51,9 +51,21 @@ if exist('sysvector.bin', 'file')
gps = sysvector(:,33:35); gps = sysvector(:,33:35);
gps(~any(gps,2), :) = []; gps(~any(gps,2), :) = [];
plot3(gps(:,1), gps(:,2), gps(:,3)); all_data = figure('Name', 'GPS RAW');
gps_position = plot3(gps(:,1), gps(:,2), gps(:,3));
all_data = figure('Name', 'Complete Log Data (exc. GPS)');
plot(sysvector(:,1), sysvector(:,2:32)); plot(sysvector(:,1), sysvector(:,2:32));
actuator_inputs = figure('Name', 'Attitude controller outputs');
plot(sysvector(:,1), sysvector(:,14:17));
legend('roll motor setpoint', 'pitch motor setpoint', 'yaw motor setpoint', 'throttle motor setpoint');
actuator_outputs = figure('Name', 'Actuator outputs');
plot(sysvector(:,1), sysvector(:,18:25));
legend('actuator 0', 'actuator 1', 'actuator 2', 'actuator 3', 'actuator 4', 'actuator 5', 'actuator 6', 'actuator 7');
end end
if exist('actuator_outputs0.bin', 'file') if exist('actuator_outputs0.bin', 'file')

10
apps/sdlog/sdlog.c
View File

@@ -567,6 +567,7 @@ int file_copy(const char* file_old, const char* file_new)
{ {
FILE *source, *target; FILE *source, *target;
source = fopen(file_old, "r"); source = fopen(file_old, "r");
int ret = 0;
if( source == NULL ) if( source == NULL )
{ {
@@ -580,21 +581,24 @@ int file_copy(const char* file_old, const char* file_new)
{ {
fclose(source); fclose(source);
warnx("failed to open output file to copy"); warnx("failed to open output file to copy");
return 1;
} }
char buf[128]; char buf[128];
int nread; int nread;
while ((nread = fread(buf, sizeof(buf), 1, source)) > 0) { while ((nread = fread(buf, 1, sizeof(buf), source)) > 0) {
int ret = fwrite(buf, sizeof(buf), 1, target); int ret = fwrite(buf, 1, nread, target);
if (ret <= 0) { if (ret <= 0) {
warnx("error writing file"); warnx("error writing file");
ret = 1;
break; break;
} }
} }
fsync(fileno(target));
fclose(source); fclose(source);
fclose(target); fclose(target);
return 0; return ret;
} }