/**************************************************************************** * * Copyright (c) 2016 PX4 Development Team. All rights reserved. * * Redistribution and use in source and binary forms, with or without * modification, are permitted provided that the following conditions * are met: * * 1. Redistributions of source code must retain the above copyright * notice, this list of conditions and the following disclaimer. * 2. Redistributions in binary form must reproduce the above copyright * notice, this list of conditions and the following disclaimer in * the documentation and/or other materials provided with the * distribution. * 3. Neither the name PX4 nor the names of its contributors may be * used to endorse or promote products derived from this software * without specific prior written permission. * * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE * POSSIBILITY OF SUCH DAMAGE. * ****************************************************************************/ #pragma once #include "log_writer.h" #include "array.h" #include #include #include #include #include #include extern "C" __EXPORT int logger_main(int argc, char *argv[]); #define TRY_SUBSCRIBE_INTERVAL 1000*1000 // interval in microseconds at which we try to subscribe to a topic // if we haven't succeeded before #ifdef __PX4_NUTTX #define LOG_DIR_LEN 64 #else #define LOG_DIR_LEN 256 #endif namespace px4 { namespace logger { struct LoggerSubscription { int fd[ORB_MULTI_MAX_INSTANCES]; uint16_t msg_ids[ORB_MULTI_MAX_INSTANCES]; const orb_metadata *metadata = nullptr; LoggerSubscription() {} LoggerSubscription(int fd_, const orb_metadata *metadata_) : metadata(metadata_) { fd[0] = fd_; for (int i = 1; i < ORB_MULTI_MAX_INSTANCES; i++) { fd[i] = -1; } for (int i = 0; i < ORB_MULTI_MAX_INSTANCES; i++) { msg_ids[i] = (uint16_t) - 1; } } }; class Logger { public: Logger(LogWriter::Backend backend, size_t buffer_size, uint32_t log_interval, const char *poll_topic_name, bool log_on_start, bool log_until_shutdown, bool log_name_timestamp, unsigned int queue_size); ~Logger(); /** * Tell the logger that we're in replay mode. This must be called * before starting the logger. * @param file_name file name of the used log replay file. Will be copied. */ void setReplayFile(const char *file_name); /** * Add a topic to be logged. This must be called before start_log() * (because it does not write an ADD_LOGGED_MSG message). * @param name topic name * @param interval limit rate if >0, otherwise log as fast as the topic is updated. * @return -1 on error, file descriptor otherwise */ int add_topic(const char *name, unsigned interval); /** * add a logged topic (called by add_topic() above) */ int add_topic(const orb_metadata *topic); static int start(char *const *argv); static void usage(const char *reason); void status(); void print_statistics(); void set_arm_override(bool override) { _arm_override = override; } private: static void run_trampoline(int argc, char *argv[]); void run(); /** * Write an ADD_LOGGED_MSG to the log for a all current subscriptions and instances */ void write_all_add_logged_msg(); /** * Write an ADD_LOGGED_MSG to the log for a given subscription and instance. * _writer.lock() must be held when calling this. */ void write_add_logged_msg(LoggerSubscription &subscription, int instance); /** * Create logging directory * @param tt if not null, use it for the directory name * @return 0 on success */ int create_log_dir(tm *tt); /** recursively remove a directory * @return 0 on success, <0 otherwise */ int remove_directory(const char *dir); static bool file_exist(const char *filename); /** * Get log file name with directory (create it if necessary) */ int get_log_file_name(char *file_name, size_t file_name_size); /** * Check if there is enough free space left on the SD Card. * It will remove old log files if there is not enough space, * and if that fails return 1 * @return 0 on success, 1 if not enough space, <0 on error */ int check_free_space(); void start_log_file(); void stop_log_file(); void start_log_mavlink(); void stop_log_mavlink(); /** check if mavlink logging can be started */ bool can_start_mavlink_log() const { return !_writer.is_started(LogWriter::BackendMavlink) && (_writer.backend() & LogWriter::BackendMavlink) != 0; } /** get the configured backend as string */ const char *configured_backend_mode() const; /** * write the file header with file magic and timestamp. */ void write_header(); void write_formats(); /** * write performance counters * @param preflight preflight if true, postflight otherwise */ void write_perf_data(bool preflight); /** * callback to write the performance counters */ static void perf_iterate_callback(perf_counter_t handle, void *user); /** * callback for print_load_buffer() to print the process load */ static void print_load_callback(void *user); void write_version(); void write_info(const char *name, const char *value); void write_info(const char *name, int32_t value); void write_info(const char *name, uint32_t value); /** generic common template method for write_info variants */ template void write_info_template(const char *name, T value, const char *type_str); void write_parameters(); void write_changed_parameters(); inline bool copy_if_updated_multi(LoggerSubscription &sub, int multi_instance, void *buffer, bool try_to_subscribe); /** * Write exactly one ulog message to the logger and handle dropouts. * Must be called with _writer.lock() held. * @return true if data written, false otherwise (on overflow) */ bool write_message(void *ptr, size_t size); /** * Get the time for log file name * @param tt returned time * @param boot_time use time when booted instead of current time * @return true on success, false otherwise (eg. if no gps) */ bool get_log_time(struct tm *tt, bool boot_time = false); /** * Parse a file containing a list of uORB topics to log, calling add_topic for each * @param fname name of file * @return number of topics added */ int add_topics_from_file(const char *fname); void add_default_topics(); void add_calibration_topics(); void ack_vehicle_command(orb_advert_t &vehicle_command_ack_pub, uint16_t command, uint32_t result); /** * initialize the output for the process load, so that ~1 second later it will be written to the log */ void initialize_load_output(); /** * write the process load, which was previously initialized with initialize_load_output() */ void write_load_output(bool preflight); static constexpr size_t MAX_TOPICS_NUM = 64; /**< Maximum number of logged topics */ static constexpr unsigned MAX_NO_LOGFILE = 999; /**< Maximum number of log files */ #if defined(__PX4_POSIX_EAGLE) || defined(__PX4_POSIX_EXCELSIOR) static constexpr const char *LOG_ROOT = PX4_ROOTFSDIR"/log"; #else static constexpr const char *LOG_ROOT = PX4_ROOTFSDIR"/fs/microsd/log"; #endif uint8_t *_msg_buffer = nullptr; int _msg_buffer_len = 0; char _log_dir[LOG_DIR_LEN]; int _sess_dir_index = 1; ///< search starting index for 'sess' directory name char _log_file_name[32]; bool _task_should_exit = true; bool _has_log_dir = false; bool _was_armed = false; bool _arm_override; // statistics hrt_abstime _start_time_file; ///< Time when logging started, file backend (not the logger thread) hrt_abstime _dropout_start = 0; ///< start of current dropout (0 = no dropout) float _max_dropout_duration = 0.f; ///< max duration of dropout [s] size_t _write_dropouts = 0; ///< failed buffer writes due to buffer overflow size_t _high_water = 0; ///< maximum used write buffer const bool _log_on_start; const bool _log_until_shutdown; const bool _log_name_timestamp; Array _subscriptions; LogWriter _writer; uint32_t _log_interval; const orb_metadata *_polling_topic_meta = nullptr; ///< if non-null, poll on this topic instead of sleeping param_t _log_utc_offset; param_t _log_dirs_max; orb_advert_t _mavlink_log_pub = nullptr; uint16_t _next_topic_id = 0; ///< id of next subscribed ulog topic char *_replay_file_name = nullptr; bool _should_stop_file_log = false; /**< if true _next_load_print is set and file logging will be stopped after load printing */ print_load_s _load; ///< process load data hrt_abstime _next_load_print = 0; ///< timestamp when to print the process load // control param_t _sdlog_mode_handle; int32_t _sdlog_mode; }; } //namespace logger } //namespace px4