- initial...
This commit is contained in:
		
							parent
							
								
									69c06b1b82
								
							
						
					
					
						commit
						deb55f48b7
					
				
							
								
								
									
										27
									
								
								CMakeLists.txt
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										27
									
								
								CMakeLists.txt
									
									
									
									
									
										Normal file
									
								
							@ -0,0 +1,27 @@
 | 
			
		||||
cmake_minimum_required(VERSION 3.15)
 | 
			
		||||
set(PRJ flexptp_linux)
 | 
			
		||||
project(${PRJ} C)
 | 
			
		||||
 | 
			
		||||
set(CMAKE_C_STANDARD 11)
 | 
			
		||||
 | 
			
		||||
add_executable(${PRJ}
 | 
			
		||||
        Src/cli/cli.c
 | 
			
		||||
        Src/cli/cli.h
 | 
			
		||||
        Src/cli/term_colors.h
 | 
			
		||||
        Src/main.c
 | 
			
		||||
        Inc/flexptp_options.h
 | 
			
		||||
)
 | 
			
		||||
 | 
			
		||||
target_include_directories(${PRJ} PUBLIC Modules)
 | 
			
		||||
 | 
			
		||||
set(FLEXPTP_INCLUDES ${CMAKE_CURRENT_LIST_DIR}/Inc ${CMAKE_CURRENT_LIST_DIR}/Src ${CMAKE_CURRENT_LIST_DIR}/Modules)
 | 
			
		||||
set(FLEXPTP_HWPORT LINUX)
 | 
			
		||||
set(FLEXPTP_NSD LINUX)
 | 
			
		||||
set(FLEXPTP_SERVO KALMAN)
 | 
			
		||||
add_subdirectory(Modules/flexPTP)
 | 
			
		||||
target_link_libraries(${PRJ} flexptp)
 | 
			
		||||
target_include_directories(${PRJ} PUBLIC ${FLEXPTP_INCLUDE_EXPORT} ${FLEXPTP_INCLUDES})
 | 
			
		||||
 | 
			
		||||
if (${HAVE_CLOCK_ADJTIME})
 | 
			
		||||
    target_compile_definitions(flexptp PUBLIC HAVE_CLOCK_ADJTIME=1)
 | 
			
		||||
endif ()
 | 
			
		||||
							
								
								
									
										142
									
								
								Src/main.c
									
									
									
									
									
										Normal file
									
								
							
							
						
						
									
										142
									
								
								Src/main.c
									
									
									
									
									
										Normal file
									
								
							@ -0,0 +1,142 @@
 | 
			
		||||
#include <stdio.h>
 | 
			
		||||
 | 
			
		||||
#include "cli/cli.h"
 | 
			
		||||
#include "cli/term_colors.h"
 | 
			
		||||
 | 
			
		||||
#include "flexptp/logging.h"
 | 
			
		||||
#include "flexptp/profiles.h"
 | 
			
		||||
#include "flexptp/ptp_profile_presets.h"
 | 
			
		||||
#include "flexptp/settings_interface.h"
 | 
			
		||||
#include "flexptp/task_ptp.h"
 | 
			
		||||
 | 
			
		||||
#include <signal.h>
 | 
			
		||||
#include <ctype.h>
 | 
			
		||||
#include <getopt.h>
 | 
			
		||||
#include <inttypes.h>
 | 
			
		||||
#include <net/if.h>
 | 
			
		||||
#include <signal.h>
 | 
			
		||||
#include <stdlib.h>
 | 
			
		||||
 | 
			
		||||
// ------------------------------
 | 
			
		||||
 | 
			
		||||
char ptp_if_name[IFNAMSIZ] = {0};
 | 
			
		||||
static char config_fname[FILENAME_MAX] = {0};
 | 
			
		||||
 | 
			
		||||
void flexptp_user_event_cb(PtpUserEventCode uev) {
 | 
			
		||||
    switch (uev) {
 | 
			
		||||
    case PTP_UEV_INIT_DONE:
 | 
			
		||||
        // some initial settings
 | 
			
		||||
        ptp_load_profile(ptp_profile_preset_get("gPTP"));
 | 
			
		||||
        ptp_log_enable(PTP_LOG_DEF, true);
 | 
			
		||||
        ptp_log_enable(PTP_LOG_BMCA, true);
 | 
			
		||||
 | 
			
		||||
        // load config file if defined
 | 
			
		||||
        if (config_fname[0] != '\0') {
 | 
			
		||||
            FILE *fp = fopen(config_fname, "r");
 | 
			
		||||
            if (fp != NULL) {
 | 
			
		||||
                printf(ANSI_ITALIC "Loading config...\n\n" ANSI_COLOR_RESET);
 | 
			
		||||
                char * lineBuf = NULL;
 | 
			
		||||
                size_t lineLen = 0;
 | 
			
		||||
                do {
 | 
			
		||||
                    getline(&lineBuf, &lineLen, fp);
 | 
			
		||||
                    size_t offset = 0;
 | 
			
		||||
                    while ((lineBuf[offset] != '\0') && isspace(lineBuf[offset])) {
 | 
			
		||||
                        offset++;
 | 
			
		||||
                    }
 | 
			
		||||
                    char * lineStart = lineBuf + offset;
 | 
			
		||||
                    if (lineStart[0] != '#') {
 | 
			
		||||
                        printf(ANSI_ITALIC ANSI_COLOR_GREEN "\n> %s\n" ANSI_COLOR_RESET, lineStart);
 | 
			
		||||
                        process_cli_line(lineStart);
 | 
			
		||||
                    }
 | 
			
		||||
                } while (!feof(fp));
 | 
			
		||||
                free(lineBuf);
 | 
			
		||||
                fclose(fp);
 | 
			
		||||
                printf(ANSI_ITALIC "\n...done!\n" ANSI_COLOR_RESET);
 | 
			
		||||
            }
 | 
			
		||||
        }
 | 
			
		||||
 | 
			
		||||
        break;
 | 
			
		||||
    default:
 | 
			
		||||
        break;
 | 
			
		||||
    }
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
// ------------------------------
 | 
			
		||||
 | 
			
		||||
static void print_help() {
 | 
			
		||||
    printf("-i, --interface=<interface> (required)\n"
 | 
			
		||||
           "-c, --config=<config file>\n");
 | 
			
		||||
};
 | 
			
		||||
 | 
			
		||||
static struct option interface_opt[] = {
 | 
			
		||||
    {"interface", required_argument, 0, 'i'},
 | 
			
		||||
    {"config", required_argument, 0, 'c'},
 | 
			
		||||
    {0}};
 | 
			
		||||
 | 
			
		||||
void parse_interface(int argc, char *argv[]) {
 | 
			
		||||
    // get options
 | 
			
		||||
    int option_index = 0;
 | 
			
		||||
 | 
			
		||||
    // iterate over parameters
 | 
			
		||||
    int c;
 | 
			
		||||
    while ((c = getopt_long(argc, argv, "i:c:", interface_opt, &option_index)) != -1) {
 | 
			
		||||
        switch (c) {
 | 
			
		||||
        case 'i':
 | 
			
		||||
            strncpy(ptp_if_name, optarg, IFNAMSIZ);
 | 
			
		||||
            break;
 | 
			
		||||
        case 'c':
 | 
			
		||||
            strncpy(config_fname, optarg, FILENAME_MAX);
 | 
			
		||||
            break;
 | 
			
		||||
        default:
 | 
			
		||||
            break;
 | 
			
		||||
        }
 | 
			
		||||
    }
 | 
			
		||||
 | 
			
		||||
    // verify required options
 | 
			
		||||
    if (ptp_if_name[0] == '\0') {
 | 
			
		||||
        print_help();
 | 
			
		||||
        exit(0);
 | 
			
		||||
    }
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static CMD_FUNCTION(exit_application) {
 | 
			
		||||
    printf("Exiting...\n\n");
 | 
			
		||||
    cli_exit();
 | 
			
		||||
    return 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
static void sighandler(int signum) {
 | 
			
		||||
    cli_exit();
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
int main(int argc, char *argv[]) {
 | 
			
		||||
    // register SIGINT signal handler
 | 
			
		||||
    struct sigaction sa;
 | 
			
		||||
    sa.sa_handler = sighandler;
 | 
			
		||||
    sa.sa_flags = SA_RESTART;
 | 
			
		||||
    sigemptyset(&sa.sa_mask);
 | 
			
		||||
    sigaction(SIGINT, &sa, NULL);
 | 
			
		||||
 | 
			
		||||
    // parse options
 | 
			
		||||
    parse_interface(argc, argv);
 | 
			
		||||
 | 
			
		||||
    // initialize the CLI
 | 
			
		||||
    cli_init();
 | 
			
		||||
 | 
			
		||||
    // register exit command
 | 
			
		||||
    cli_register_command("exit \t\t\t Exit application", 1, 0, exit_application);
 | 
			
		||||
 | 
			
		||||
    // register PTP task
 | 
			
		||||
    reg_task_ptp();
 | 
			
		||||
 | 
			
		||||
    // start the CLI
 | 
			
		||||
    cli_start();
 | 
			
		||||
 | 
			
		||||
    // unregister PTP task
 | 
			
		||||
    unreg_task_ptp();
 | 
			
		||||
 | 
			
		||||
    return 0;
 | 
			
		||||
}
 | 
			
		||||
 | 
			
		||||
// -------------------
 | 
			
		||||
 | 
			
		||||
		Loading…
	
	
			
			x
			
			
		
	
		Reference in New Issue
	
	Block a user