10d163575Sopenharmony_ci/*
20d163575Sopenharmony_ci * Copyright (c) 2013-2019 Huawei Technologies Co., Ltd. All rights reserved.
30d163575Sopenharmony_ci * Copyright (c) 2020-2021 Huawei Device Co., Ltd. All rights reserved.
40d163575Sopenharmony_ci *
50d163575Sopenharmony_ci * Redistribution and use in source and binary forms, with or without modification,
60d163575Sopenharmony_ci * are permitted provided that the following conditions are met:
70d163575Sopenharmony_ci *
80d163575Sopenharmony_ci * 1. Redistributions of source code must retain the above copyright notice, this list of
90d163575Sopenharmony_ci *    conditions and the following disclaimer.
100d163575Sopenharmony_ci *
110d163575Sopenharmony_ci * 2. Redistributions in binary form must reproduce the above copyright notice, this list
120d163575Sopenharmony_ci *    of conditions and the following disclaimer in the documentation and/or other materials
130d163575Sopenharmony_ci *    provided with the distribution.
140d163575Sopenharmony_ci *
150d163575Sopenharmony_ci * 3. Neither the name of the copyright holder nor the names of its contributors may be used
160d163575Sopenharmony_ci *    to endorse or promote products derived from this software without specific prior written
170d163575Sopenharmony_ci *    permission.
180d163575Sopenharmony_ci *
190d163575Sopenharmony_ci * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
200d163575Sopenharmony_ci * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
210d163575Sopenharmony_ci * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
220d163575Sopenharmony_ci * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR
230d163575Sopenharmony_ci * CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
240d163575Sopenharmony_ci * EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
250d163575Sopenharmony_ci * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS;
260d163575Sopenharmony_ci * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY,
270d163575Sopenharmony_ci * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR
280d163575Sopenharmony_ci * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF
290d163575Sopenharmony_ci * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
300d163575Sopenharmony_ci */
310d163575Sopenharmony_ci
320d163575Sopenharmony_ci#include <stdio.h>
330d163575Sopenharmony_ci#include <stdlib.h>
340d163575Sopenharmony_ci#include <string.h>
350d163575Sopenharmony_ci#include <sys/types.h>
360d163575Sopenharmony_ci#include <sys/stat.h>
370d163575Sopenharmony_ci#include <sys/ioctl.h>
380d163575Sopenharmony_ci#include <fcntl.h>
390d163575Sopenharmony_ci#include <unistd.h>
400d163575Sopenharmony_ci#include <sys/mman.h>
410d163575Sopenharmony_ci#include <stdint.h>
420d163575Sopenharmony_ci
430d163575Sopenharmony_ci#define TRACE_IOC_MAGIC     'T'
440d163575Sopenharmony_ci#define TRACE_START         _IO(TRACE_IOC_MAGIC, 1)
450d163575Sopenharmony_ci#define TRACE_STOP          _IO(TRACE_IOC_MAGIC, 2)
460d163575Sopenharmony_ci#define TRACE_RESET         _IO(TRACE_IOC_MAGIC, 3)
470d163575Sopenharmony_ci#define TRACE_DUMP          _IO(TRACE_IOC_MAGIC, 4)
480d163575Sopenharmony_ci#define TRACE_SET_MASK      _IO(TRACE_IOC_MAGIC, 5)
490d163575Sopenharmony_ci
500d163575Sopenharmony_ci#define TRACE_USR_MAX_PARAMS 3
510d163575Sopenharmony_citypedef struct {
520d163575Sopenharmony_ci    unsigned int eventType;
530d163575Sopenharmony_ci    uintptr_t identity;
540d163575Sopenharmony_ci    uintptr_t params[TRACE_USR_MAX_PARAMS];
550d163575Sopenharmony_ci} UsrEventInfo;
560d163575Sopenharmony_ci
570d163575Sopenharmony_cistatic void TraceUsage(void)
580d163575Sopenharmony_ci{
590d163575Sopenharmony_ci    printf("\nUsage: ./trace [start] Start to trace events.\n");
600d163575Sopenharmony_ci    printf("\nUsage: ./trace [stop] Stop trace.\n");
610d163575Sopenharmony_ci    printf("\nUsage: ./trace [reset] Clear the trace record buffer.\n");
620d163575Sopenharmony_ci    printf("\nUsage: ./trace [dump 0/1] Format printf trace data,"
630d163575Sopenharmony_ci                "0/1 stands for whether to send data to studio for analysis.\n");
640d163575Sopenharmony_ci    printf("\nUsage: ./trace [mask num] Set trace filter event mask.\n");
650d163575Sopenharmony_ci    printf("\nUsage: ./trace [read nBytes] Read nBytes raw data from trace buffer.\n");
660d163575Sopenharmony_ci    printf("\nUsage: ./trace [write type id params..] Write a user event, no more than 3 parameters.\n");
670d163575Sopenharmony_ci}
680d163575Sopenharmony_ci
690d163575Sopenharmony_cistatic void TraceRead(int fd, size_t size)
700d163575Sopenharmony_ci{
710d163575Sopenharmony_ci    ssize_t i;
720d163575Sopenharmony_ci    ssize_t len;
730d163575Sopenharmony_ci    if (size == 0) {
740d163575Sopenharmony_ci        return;
750d163575Sopenharmony_ci    }
760d163575Sopenharmony_ci
770d163575Sopenharmony_ci    char *buffer = (char *)malloc(size);
780d163575Sopenharmony_ci    if (buffer == NULL) {
790d163575Sopenharmony_ci        printf("Read buffer malloc failed.\n");
800d163575Sopenharmony_ci        return;
810d163575Sopenharmony_ci    }
820d163575Sopenharmony_ci
830d163575Sopenharmony_ci    len = read(fd, buffer, size);
840d163575Sopenharmony_ci    for (i = 0; i < len; i++) {
850d163575Sopenharmony_ci        printf("%02x ", buffer[i] & 0xFF);
860d163575Sopenharmony_ci    }
870d163575Sopenharmony_ci    printf("\n");
880d163575Sopenharmony_ci    free(buffer);
890d163575Sopenharmony_ci}
900d163575Sopenharmony_ci
910d163575Sopenharmony_cistatic void TraceWrite(int fd, int argc, char **argv)
920d163575Sopenharmony_ci{
930d163575Sopenharmony_ci    int i;
940d163575Sopenharmony_ci    UsrEventInfo info = {0};
950d163575Sopenharmony_ci    info.eventType = strtoul(argv[2], NULL, 0); /* 2, argv number  */
960d163575Sopenharmony_ci    info.identity = strtoul(argv[3], NULL, 0); /* 3, argv number  */
970d163575Sopenharmony_ci    /* 4, argc -4 means user argv that does not contain argv[0]~argv[3] */
980d163575Sopenharmony_ci    int paramNum = (argc - 4) > TRACE_USR_MAX_PARAMS ? TRACE_USR_MAX_PARAMS : (argc - 4);
990d163575Sopenharmony_ci
1000d163575Sopenharmony_ci    for (i = 0; i < paramNum; i++) {
1010d163575Sopenharmony_ci        /* 4, argc -4 means user argv that does not contain argv[0]~argv[3] */
1020d163575Sopenharmony_ci        info.params[i] = strtoul(argv[4 + i], NULL, 0);
1030d163575Sopenharmony_ci    }
1040d163575Sopenharmony_ci    (void)write(fd, &info, sizeof(UsrEventInfo));
1050d163575Sopenharmony_ci}
1060d163575Sopenharmony_ci
1070d163575Sopenharmony_ciint main(int argc, char **argv)
1080d163575Sopenharmony_ci{
1090d163575Sopenharmony_ci    int fd = open("/dev/trace", O_RDWR);
1100d163575Sopenharmony_ci    if (fd == -1) {
1110d163575Sopenharmony_ci        printf("Trace open failed.\n");
1120d163575Sopenharmony_ci        exit(EXIT_FAILURE);
1130d163575Sopenharmony_ci    }
1140d163575Sopenharmony_ci
1150d163575Sopenharmony_ci    if (argc == 1) {
1160d163575Sopenharmony_ci        TraceUsage();
1170d163575Sopenharmony_ci    } else if (argc == 2 && strcmp(argv[1], "start") == 0) { /* 2, argv num, no special meaning */
1180d163575Sopenharmony_ci        ioctl(fd, TRACE_START, NULL);
1190d163575Sopenharmony_ci    } else if (argc == 2 && strcmp(argv[1], "stop") == 0) { /* 2, argv num, no special meaning */
1200d163575Sopenharmony_ci        ioctl(fd, TRACE_STOP, NULL);
1210d163575Sopenharmony_ci    } else if (argc == 2 && strcmp(argv[1], "reset") == 0) { /* 2, argv num, no special meaning */
1220d163575Sopenharmony_ci        ioctl(fd, TRACE_RESET, NULL);
1230d163575Sopenharmony_ci    } else if (argc == 3 && strcmp(argv[1], "mask") == 0) { /* 3, argv num, no special meaning */
1240d163575Sopenharmony_ci        size_t mask = strtoul(argv[2], NULL, 0);
1250d163575Sopenharmony_ci        ioctl(fd, TRACE_SET_MASK, mask);
1260d163575Sopenharmony_ci    } else if (argc == 3 && strcmp(argv[1], "dump") == 0) { /* 3, argv num, no special meaning */
1270d163575Sopenharmony_ci        size_t flag = strtoul(argv[2], NULL, 0);
1280d163575Sopenharmony_ci        ioctl(fd, TRACE_DUMP, flag);
1290d163575Sopenharmony_ci    } else if (argc == 3 && strcmp(argv[1], "read") == 0) { /* 3, argv num, no special meaning */
1300d163575Sopenharmony_ci        size_t size = strtoul(argv[2], NULL, 0);
1310d163575Sopenharmony_ci        TraceRead(fd, size);
1320d163575Sopenharmony_ci    } else if (argc >= 4 && strcmp(argv[1], "write") == 0) { /* 4, argv num, no special meaning */
1330d163575Sopenharmony_ci        TraceWrite(fd, argc, argv);
1340d163575Sopenharmony_ci    } else {
1350d163575Sopenharmony_ci        printf("Unsupported trace command.\n");
1360d163575Sopenharmony_ci        TraceUsage();
1370d163575Sopenharmony_ci    }
1380d163575Sopenharmony_ci
1390d163575Sopenharmony_ci    close(fd);
1400d163575Sopenharmony_ci    return 0;
1410d163575Sopenharmony_ci}
142