2 Commits
19 changed files with 302 additions and 153 deletions
+8
View File
@@ -75,6 +75,7 @@ jobs:
gcc \ gcc \
gcc-aarch64-linux-gnu \ gcc-aarch64-linux-gnu \
gcc-arm-linux-gnueabihf \ gcc-arm-linux-gnueabihf \
gcc-mips-linux-gnu \
libgps-dev \ libgps-dev \
make make
@@ -138,6 +139,13 @@ jobs:
podman exec -i stable cmake -DCMAKE_BUILD_TYPE=Debug -DCMAKE_TOOLCHAIN_FILE=cmake/${toolchain}.cmake -DENABLE_WERROR=ON -DENABLE_GPS=${gps} -B build-${toolchain} podman exec -i stable cmake -DCMAKE_BUILD_TYPE=Debug -DCMAKE_TOOLCHAIN_FILE=cmake/${toolchain}.cmake -DENABLE_WERROR=ON -DENABLE_GPS=${gps} -B build-${toolchain}
podman exec -i stable cmake --build build-${toolchain} podman exec -i stable cmake --build build-${toolchain}
- name: Configure & Build with mips-linux-gnu-gcc
env:
toolchain: mips-linux-gnu-gcc
run: |
podman exec -i stable cmake -DCMAKE_BUILD_TYPE=Debug -DCMAKE_TOOLCHAIN_FILE=cmake/${toolchain}.cmake -DENABLE_WERROR=ON -B build-${toolchain}
podman exec -i stable cmake --build build-${toolchain}
- name: Configure & Build with gcc (Makefile) - name: Configure & Build with gcc (Makefile)
env: env:
cc: gcc cc: gcc
+1 -1
View File
@@ -1,4 +1,4 @@
cmake_minimum_required(VERSION 3.5...3.10) cmake_minimum_required(VERSION 3.5)
project(can-utils LANGUAGES C) project(can-utils LANGUAGES C)
+7 -7
View File
@@ -84,7 +84,7 @@ static void print_usage(char *prg)
} }
static void prframe(FILE *file, struct timeval *tv, int dev, static void prframe(FILE *file, struct timeval *tv, int dev,
union cfu *cf, char dir) cu_t *cf, char dir)
{ {
static char abuf[BUFLEN]; static char abuf[BUFLEN];
@@ -177,7 +177,7 @@ static void eval_can(char* buf, struct timeval *date_tvp, char timestamps,
cf.len = CAN_ERR_DLC; cf.len = CAN_ERR_DLC;
calc_tv(&tv, &read_tv, date_tvp, timestamps, dplace); calc_tv(&tv, &read_tv, date_tvp, timestamps, dplace);
prframe(outfile, &tv, interface, (union cfu *)&cf, NO_DIR); prframe(outfile, &tv, interface, (cu_t *)&cf, NO_DIR);
fflush(outfile); fflush(outfile);
return; return;
} }
@@ -249,7 +249,7 @@ static void eval_can(char* buf, struct timeval *date_tvp, char timestamps,
cf.data[i] = data[i] & 0xFFU; cf.data[i] = data[i] & 0xFFU;
calc_tv(&tv, &read_tv, date_tvp, timestamps, dplace); calc_tv(&tv, &read_tv, date_tvp, timestamps, dplace);
prframe(outfile, &tv, interface, (union cfu *)&cf, dir[0]); prframe(outfile, &tv, interface, (cu_t *)&cf, dir[0]);
fflush(outfile); fflush(outfile);
} }
} }
@@ -374,7 +374,7 @@ static void eval_canfd(char* buf, struct timeval *date_tvp, char timestamps,
} }
calc_tv(&tv, &read_tv, date_tvp, timestamps, dplace); calc_tv(&tv, &read_tv, date_tvp, timestamps, dplace);
prframe(outfile, &tv, interface, (union cfu *)&cf, dir[0]); prframe(outfile, &tv, interface, (cu_t *)&cf, dir[0]);
fflush(outfile); fflush(outfile);
/* No support for really strange CANFD ErrorFrames format m( */ /* No support for really strange CANFD ErrorFrames format m( */
@@ -487,7 +487,7 @@ static void eval_canxl_cc(char* buf, struct timeval *date_tvp, char timestamps,
cf.len8_dlc = dlc; cf.len8_dlc = dlc;
calc_tv(&tv, &read_tv, date_tvp, timestamps, dplace); calc_tv(&tv, &read_tv, date_tvp, timestamps, dplace);
prframe(outfile, &tv, interface, (union cfu *)&cf, dir[0]); prframe(outfile, &tv, interface, (cu_t *)&cf, dir[0]);
fflush(outfile); fflush(outfile);
} }
@@ -594,7 +594,7 @@ static void eval_canxl_fd(char* buf, struct timeval *date_tvp, char timestamps,
cf.flags |= CANFD_ESI; cf.flags |= CANFD_ESI;
calc_tv(&tv, &read_tv, date_tvp, timestamps, dplace); calc_tv(&tv, &read_tv, date_tvp, timestamps, dplace);
prframe(outfile, &tv, interface, (union cfu *)&cf, dir[0]); prframe(outfile, &tv, interface, (cu_t *)&cf, dir[0]);
fflush(outfile); fflush(outfile);
} }
@@ -723,7 +723,7 @@ static void eval_canxl_xl(char* buf, struct timeval *date_tvp, char timestamps,
cf.flags |= CANXL_RRS; cf.flags |= CANXL_RRS;
calc_tv(&tv, &read_tv, date_tvp, timestamps, dplace); calc_tv(&tv, &read_tv, date_tvp, timestamps, dplace);
prframe(outfile, &tv, interface, (union cfu *)&cf, dir[0]); prframe(outfile, &tv, interface, (cu_t *)&cf, dir[0]);
fflush(outfile); fflush(outfile);
/* No support for CAN XL ErrorFrames */ /* No support for CAN XL ErrorFrames */
+8 -28
View File
@@ -153,7 +153,7 @@ int main(void)
char buf[MAXLEN]; char buf[MAXLEN];
char format[FORMATSZ]; char format[FORMATSZ];
char rxmsg[64]; char rxmsg[50];
#pragma GCC diagnostic push #pragma GCC diagnostic push
#pragma GCC diagnostic ignored "-Wpragmas" #pragma GCC diagnostic ignored "-Wpragmas"
@@ -234,7 +234,7 @@ int main(void)
} }
while (1) { while (1) {
again:
FD_ZERO(&readfds); FD_ZERO(&readfds);
FD_SET(sc, &readfds); FD_SET(sc, &readfds);
FD_SET(sa, &readfds); FD_SET(sa, &readfds);
@@ -242,8 +242,6 @@ again:
select((sc > sa)?sc+1:sa+1, &readfds, NULL, NULL, NULL); select((sc > sa)?sc+1:sa+1, &readfds, NULL, NULL, NULL);
if (FD_ISSET(sc, &readfds)) { if (FD_ISSET(sc, &readfds)) {
size_t size = sizeof(rxmsg);
int len = 0, res;
recvfrom(sc, &msg, sizeof(msg), 0, recvfrom(sc, &msg, sizeof(msg), 0,
(struct sockaddr*)&caddr, &caddrlen); (struct sockaddr*)&caddr, &caddrlen);
@@ -251,35 +249,17 @@ again:
ifr.ifr_ifindex = caddr.can_ifindex; ifr.ifr_ifindex = caddr.can_ifindex;
ioctl(sc, SIOCGIFNAME, &ifr); ioctl(sc, SIOCGIFNAME, &ifr);
res = snprintf(rxmsg, size, "< %s %03X %d ", ifr.ifr_name, sprintf(rxmsg, "< %s %03X %d ", ifr.ifr_name,
msg.msg_head.can_id, msg.frame.can_dlc); msg.msg_head.can_id, msg.frame.can_dlc);
if (res < 0 || (size_t)res >= size) {
printf("Error: rxmsg buffer (size %zu) too small for data.\n", size);
continue;
}
len += res; for ( i = 0; i < msg.frame.can_dlc; i++)
sprintf(rxmsg + strlen(rxmsg), "%02X ",
for (i = 0; i < msg.frame.can_dlc; i++) { msg.frame.data[i]);
res = snprintf(rxmsg + len, size - len, "%02X ", msg.frame.data[i]);
if (res < 0 || (size_t)res >= (size - len)) {
printf("Error: rxmsg buffer (size %zu) too small for data.\n", size);
goto again;
}
len += res;
}
/* delimiter '\0' for Adobe(TM) Flash(TM) XML sockets */ /* delimiter '\0' for Adobe(TM) Flash(TM) XML sockets */
res = snprintf(rxmsg + len, size - len, ">"); strcat(rxmsg, ">\0");
if (res < 0 || (size_t)res >= (size - len)) {
printf("Error: rxmsg buffer (size %zu) too small for data.\n", size);
continue;
}
len += res; send(sa, rxmsg, strlen(rxmsg) + 1, 0);
send(sa, rxmsg, len + 1, 0);
} }
+1 -1
View File
@@ -342,7 +342,7 @@ int main(int argc, char **argv)
struct cmsghdr *cmsg; struct cmsghdr *cmsg;
struct can_filter *rfilter; struct can_filter *rfilter;
can_err_mask_t err_mask; can_err_mask_t err_mask;
static union cfu cu; /* union for CAN CC/FD/XL frames */ static cu_t cu; /* union for CAN CC/FD/XL frames */
int nbytes, i; int nbytes, i;
struct ifreq ifr; struct ifreq ifr;
struct timespec ts, last_ts; struct timespec ts, last_ts;
+19 -18
View File
@@ -25,7 +25,6 @@
#include <linux/can/error.h> #include <linux/can/error.h>
#include <linux/can/raw.h> #include <linux/can/raw.h>
#include <net/if.h> #include <net/if.h>
#include <stdarg.h>
#include <stdbool.h> #include <stdbool.h>
#include <stdint.h> #include <stdint.h>
#include <stdio.h> #include <stdio.h>
@@ -123,25 +122,27 @@ void show_help_and_exit()
exit(EXIT_SUCCESS); exit(EXIT_SUCCESS);
} }
void __attribute__((format (printf, 1, 2))) err_exit(const char *format, ...) void err_exit(const char *msg)
{ {
va_list ap; printf("%s", msg);
va_start(ap, format);
vfprintf(stdout, format, ap);
va_end(ap);
exit(EXIT_FAILURE); exit(EXIT_FAILURE);
} }
void show_custom_format_and_exit(const char *param, const char *format)
{
char str_buf[80];
sprintf(str_buf, format, param);
err_exit(str_buf);
}
void show_invalid_option(const char *option) void show_invalid_option(const char *option)
{ {
err_exit("Error: Invalid option %s\n", option); show_custom_format_and_exit(option, "Error: Invalid option %s\n");
} }
void show_err_and_exit(const char *err_type) void show_err_and_exit(const char *err_type)
{ {
err_exit("Error: You can only have one %s parameter!\n", err_type); show_custom_format_and_exit(err_type, "Error: You can only have one %s parameter!\n");
} }
void show_loc_err_and_exit() void show_loc_err_and_exit()
@@ -175,6 +176,7 @@ int main(int argc, char *argv[])
struct ifreq ifr; struct ifreq ifr;
struct can_frame frame; struct can_frame frame;
bool show_bits = false, location_processed = false, transceiver_processed = false, arbitration_processed = false; bool show_bits = false, location_processed = false, transceiver_processed = false, arbitration_processed = false;
char tmp_str[256];
printf("CAN Sockets Error Messages Simulator\n"); printf("CAN Sockets Error Messages Simulator\n");
if (argc < 3) if (argc < 3)
@@ -535,25 +537,24 @@ int main(int argc, char *argv[])
// create socket // create socket
if ((sock = socket(PF_CAN, SOCK_RAW, CAN_RAW)) < 0) if ((sock = socket(PF_CAN, SOCK_RAW, CAN_RAW)) < 0)
err_exit("Error while opening socket\n"); err_exit("Error while opening socket");
// set interface name // set interface name
if (strlen(argv[1]) >= IFNAMSIZ)
err_exit("Name of CAN device '%s' is too long!\n\n", argv[1]);
strcpy(ifr.ifr_name, argv[1]); // can0, vcan0... strcpy(ifr.ifr_name, argv[1]); // can0, vcan0...
if (ioctl(sock, SIOCGIFINDEX, &ifr) < 0) if (ioctl(sock, SIOCGIFINDEX, &ifr) < 0) {
err_exit("Error setting CAN interface name %s\n", argv[1]); sprintf(tmp_str, "Error setting CAN interface name %s", argv[1]);
err_exit(tmp_str);
}
// bind socket to the CAN interface // bind socket to the CAN interface
addr.can_family = AF_CAN; addr.can_family = AF_CAN;
addr.can_ifindex = ifr.ifr_ifindex; addr.can_ifindex = ifr.ifr_ifindex;
if (bind(sock, (struct sockaddr *)&addr, sizeof(addr)) < 0) if (bind(sock, (struct sockaddr *)&addr, sizeof(addr)) < 0)
err_exit("Error in socket bind\n"); err_exit("Error in socket bind");
// Send CAN error frame // Send CAN error frame
if (write(sock, &frame, sizeof(frame)) < 0) if (write(sock, &frame, sizeof(frame)) < 0)
err_exit("Error writing to socket\n"); err_exit("Error writing to socket");
else else
printf("CAN error frame sent\n"); printf("CAN error frame sent\n");
+2 -2
View File
@@ -299,7 +299,7 @@ static int setsockopt_txtime(int fd)
return 0; return 0;
} }
static int do_send_one(int fd, union cfu *cu, size_t len, int timeout) static int do_send_one(int fd, cu_t *cu, size_t len, int timeout)
{ {
uint8_t control[CMSG_SPACE(sizeof(uint64_t))] = { 0 }; uint8_t control[CMSG_SPACE(sizeof(uint64_t))] = { 0 };
struct iovec iov = { struct iovec iov = {
@@ -494,7 +494,7 @@ int main(int argc, char **argv)
struct can_raw_vcid_options vcid_opts = { struct can_raw_vcid_options vcid_opts = {
.flags = CAN_RAW_XL_VCID_TX_PASS, .flags = CAN_RAW_XL_VCID_TX_PASS,
}; };
static union cfu cu; static cu_t cu;
int i; int i;
struct ifreq ifr = { 0 }; struct ifreq ifr = { 0 };
const int enable_canfx = 1; const int enable_canfx = 1;
+4 -26
View File
@@ -177,8 +177,7 @@ int main(int argc, char **argv)
sigset_t sigset; sigset_t sigset;
fd_set rdfs; fd_set rdfs;
int s[MAXDEV]; int s[MAXDEV];
int socki; int socki, accsocket;
int accsocket = -1;
canid_t mask[MAXDEV] = {0}; canid_t mask[MAXDEV] = {0};
canid_t value[MAXDEV] = {0}; canid_t value[MAXDEV] = {0};
int inv_filter[MAXDEV] = {0}; int inv_filter[MAXDEV] = {0};
@@ -192,7 +191,7 @@ int main(int argc, char **argv)
.rx_vcid_mask = 0, .rx_vcid_mask = 0,
}; };
struct can_filter rfilter; struct can_filter rfilter;
static union cfu cu; /* union for CAN CC/FD/XL frames */ static cu_t cu; /* union for CAN CC/FD/XL frames */
const int canfx_on = 1; const int canfx_on = 1;
int nbytes, i, j; int nbytes, i, j;
struct ifreq ifr; struct ifreq ifr;
@@ -287,7 +286,7 @@ int main(int argc, char **argv)
inaddr.sin_addr.s_addr = htonl(INADDR_ANY); inaddr.sin_addr.s_addr = htonl(INADDR_ANY);
inaddr.sin_port = htons(port); inaddr.sin_port = htons(port);
while(running && bind(socki, (struct sockaddr*)&inaddr, sizeof(inaddr)) < 0) { while(bind(socki, (struct sockaddr*)&inaddr, sizeof(inaddr)) < 0) {
struct timespec f = { struct timespec f = {
.tv_nsec = 100 * 1000 * 1000, .tv_nsec = 100 * 1000 * 1000,
}; };
@@ -296,28 +295,18 @@ int main(int argc, char **argv)
nanosleep(&f, NULL); nanosleep(&f, NULL);
} }
/*
* Check if loop exited due to signal (during nanosleep) rather than
* successful bind.
*/
if (!running) {
close(socki);
return 128 + signal_num;
}
if (listen(socki, 3) != 0) { if (listen(socki, 3) != 0) {
perror("listen"); perror("listen");
exit(1); exit(1);
} }
while(running) { while(1) {
accsocket = accept(socki, (struct sockaddr*)&clientaddr, &sin_size); accsocket = accept(socki, (struct sockaddr*)&clientaddr, &sin_size);
if (accsocket > 0) { if (accsocket > 0) {
//printf("accepted\n"); //printf("accepted\n");
if (!fork()) if (!fork())
break; break;
close(accsocket); close(accsocket);
accsocket = -1;
} }
else if (errno != EINTR) { else if (errno != EINTR) {
perror("accept"); perror("accept");
@@ -325,17 +314,6 @@ int main(int argc, char **argv)
} }
} }
/*
* Check if loop exited due to signal (accept returned EINTR) rather
* than successful fork
*/
if (!running) {
if (accsocket > 0)
close(accsocket);
close(socki);
return 128 + signal_num;
}
for (i=0; i<currmax; i++) { for (i=0; i<currmax; i++) {
pr_debug("open %d '%s' m%08X v%08X i%d e%d.\n", pr_debug("open %d '%s' m%08X v%08X i%d e%d.\n",
+205
View File
@@ -0,0 +1,205 @@
#!/bin/bash
if [ -z "${CANPLAYER}" ]; then
CANPLAYER="canplayer"
fi
die() {
echo "$*" > /dev/stderr
exit 1
}
usage() {
echo "canplayer-bisect <start|stop|clean|good|yes|bad|no|again|where|undo> <logfile> <canplayer options>"
}
is_ready() {
if [ ! -d .canplayer-bisect ]; then
usage
exit 1
fi
return 0
}
setup() {
is_ready
LOGFILE=$(cat .canplayer-bisect/logfile |head -n 1)
SAVED_LEN="$(cat .canplayer-bisect/len|tail -n 1)"
LEN="$(wc -l ${LOGFILE} | awk '{ print $1 }')"
if [ "$LEN" != "$SAVED_LEN" ]; then
die "logfile has changed size. restart"
fi
CANPLAYER_ARGS=$(cat .canplayer-bisect/args |head -n 1)
HEAD="$(cat .canplayer-bisect/head |tail -n 1)"
TAIL="$(cat .canplayer-bisect/tail |tail -n 1)"
}
back() {
HEAD="$(cat .canplayer-bisect/head |tail -n 2 |head -n1)"
TAIL="$(cat .canplayer-bisect/tail |tail -n 2 |head -n1)"
}
do_undo() {
sed -i '$ d' .canplayer-bisect/head
sed -i '$ d' .canplayer-bisect/tail
}
teardown() {
mkdir -p .canplayer-bisect
echo $LEN > .canplayer-bisect/len
echo $LOGFILE > .canplayer-bisect/logfile
echo $CANPLAYER_ARGS > .canplayer-bisect/args
echo $HEAD >> .canplayer-bisect/head
echo $TAIL >> .canplayer-bisect/tail
}
show() {
cat $LOGFILE | sed -n ${HEAD},${TAIL}p
}
play() {
#we *could* pipe directly to canplayer, but then the user can't add -l i to CANPLAYER_ARGS to hunt for packets using looped playback
the_show="$(mktemp)"
trap "rm -rf \"${the_show}\"" EXIT
show > "${the_show}"
"${CANPLAYER}" ${CANPLAYER_ARGS} -I "${the_show}"
}
do_show() {
setup
show
}
check_heads_n_tails() {
if [ $HEAD -eq $TAIL ]; then
do_stop
fi
}
do_good() {
setup
check_heads_n_tails
if [ $(( $HEAD + 1 )) -eq $TAIL ]; then
TAIL=$HEAD
else
TAIL=$(( ( $TAIL - $HEAD ) / 2 + $HEAD - 1 ))
fi
teardown
play
}
do_bad() {
setup
check_heads_n_tails
back
if [ $(( $HEAD + 1 )) -eq $TAIL ]; then
HEAD=$TAIL
else
HEAD=$(( ( $TAIL - $HEAD ) / 2 + $HEAD ))
fi
teardown
play
}
do_again() {
setup
play
}
do_start() {
do_clean
LEN="$(wc -l ${LOGFILE} | awk '{ print $1 }')"
HEAD=1
TAIL=$LEN
echo "assuming logfile contains the packets you seek... bisecting to first half"
teardown
play
}
do_where() {
setup
echo "between $HEAD and $TAIL (+$(( $TAIL - $HEAD ))) of $LOGFILE"
}
do_stop() {
setup
if [ "$COMMAND" == "no" ]; then
echo "failed to find what you were looking for"
exit 1
else
echo "the packets you seek are:"
do_where
exit 0
fi
}
do_clean() {
rm -rf .canplayer-bisect
}
if [ -z "$1" ]; then
usage
exit 1
fi
COMMAND=$1
if [ ! -d .canplayer-bisect ] && [ ! -z "$2" ] && [ ! -e "$2" ]; then
usage
exit 1
fi
LOGFILE="$2"
shift
shift
CANPLAYER_ARGS="$*"
case "$COMMAND" in
start)
do_start
;;
stop)
do_stop
;;
clean)
do_clean
;;
good|yes)
do_good
;;
bad|no)
do_bad
;;
again)
do_again
;;
where)
do_where
;;
undo)
do_undo
;;
show)
do_show
;;
esac
+1 -1
View File
@@ -261,7 +261,7 @@ int main(int argc, char **argv)
struct can_raw_vcid_options vcid_opts = { struct can_raw_vcid_options vcid_opts = {
.flags = CAN_RAW_XL_VCID_TX_PASS, .flags = CAN_RAW_XL_VCID_TX_PASS,
}; };
static union cfu cu; static cu_t cu;
static struct timeval today_tv, log_tv, last_log_tv, diff_tv; static struct timeval today_tv, log_tv, last_log_tv, diff_tv;
struct timespec sleep_ts; struct timespec sleep_ts;
int s; /* CAN_RAW socket */ int s; /* CAN_RAW socket */
+1 -1
View File
@@ -117,7 +117,7 @@ int main(int argc, char **argv)
struct can_raw_vcid_options vcid_opts = { struct can_raw_vcid_options vcid_opts = {
.flags = CAN_RAW_XL_VCID_TX_PASS, .flags = CAN_RAW_XL_VCID_TX_PASS,
}; };
static union cfu cu; static cu_t cu;
struct ifreq ifr; struct ifreq ifr;
/* check command line options */ /* check command line options */
-6
View File
@@ -41,7 +41,6 @@ static void gmtime_to_j1939_pgn_65254_td(struct j1939_time_date_packet *tdp)
utc_tm = gmtime_r(&now, &utc_tm_buf); utc_tm = gmtime_r(&now, &utc_tm_buf);
local_tm = localtime_r(&now, &local_tm_buf); local_tm = localtime_r(&now, &local_tm_buf);
if (local_tm) {
/* Calculate the offsets */ /* Calculate the offsets */
hour_offset = local_tm->tm_hour - utc_tm->tm_hour; hour_offset = local_tm->tm_hour - utc_tm->tm_hour;
minute_offset = local_tm->tm_min - utc_tm->tm_min; minute_offset = local_tm->tm_min - utc_tm->tm_min;
@@ -53,11 +52,6 @@ static void gmtime_to_j1939_pgn_65254_td(struct j1939_time_date_packet *tdp)
else else
hour_offset -= 24; /* before midnight */ hour_offset -= 24; /* before midnight */
} }
} else {
/* The local time offsets cannot be determined at the moment */
hour_offset = 0xF9;
minute_offset = 0xFF;
}
/* /*
* Seconds (spn959): * Seconds (spn959):
@@ -51,7 +51,7 @@ struct j1939_vp_err_msg {
#define J1939_VP1_PRIO_DEFAULT 6 #define J1939_VP1_PRIO_DEFAULT 6
#define J1939_VP1_MAX_TRANSFER_LENGH \ #define J1939_VP1_MAX_TRANSFER_LENGH \
sizeof(struct j1939_vp1_packet) sizeof(struct j1939_vp1_packet)
#define J1939_VP1_REPETITION_RATE_MS 1000 #define J1939_VP1_REPETITION_RATE_MS 5000
#define J1939_VP1_JITTER_MS 500 #define J1939_VP1_JITTER_MS 500
/** /**
@@ -63,8 +63,8 @@ struct j1939_vp_err_msg {
* - Data Length: 4 bytes * - Data Length: 4 bytes
* - Resolution: 10^-7 deg/bit * - Resolution: 10^-7 deg/bit
* - Offset: -210 degrees * - Offset: -210 degrees
* - Range: -210 to +211.10081215 degrees * - Range: -210 to +211.1008122 degrees
* - Operating Range: -210 degrees (SOUTH) to +211.1081215 degrees * - Operating Range: -210 degrees (SOUTH) to +211.108122 degrees
* (NORTH) * (NORTH)
* *
* @longitude: Raw longitude position of the vehicle * @longitude: Raw longitude position of the vehicle
@@ -72,8 +72,8 @@ struct j1939_vp_err_msg {
* - Data Length: 4 bytes * - Data Length: 4 bytes
* - Resolution: 10^-7 deg/bit * - Resolution: 10^-7 deg/bit
* - Offset: -210 degrees * - Offset: -210 degrees
* - Range: -210 to +211.10081215 degrees * - Range: -210 to +211.1008122 degrees
* - Operating Range: -210 degrees (WEST) to +211.1081215 degrees * - Operating Range: -210 degrees (WEST) to +211.108122 degrees
* (EAST) * (EAST)
* *
* This structure defines each component of the Vehicle Position as described in * This structure defines each component of the Vehicle Position as described in
@@ -142,35 +142,32 @@ j1939_vp1_set_longitude(struct j1939_vp1_packet *packet, int32_t longitude)
/** /**
* struct j1939_vp2_packet - Represents the PGN 64502 Vehicle * struct j1939_vp2_packet - Represents the PGN 64502 Vehicle
* Position 2 packet * Position 2 packet
* FIXME: current packet layout is guessed based on limited information:
* https://www.isobus.net/isobus/pGNAndSPN/10801?type=PGN
* *
* @total_satellites: Total number of satellites in view * @total_satellites: Total number of satellites in view
* - SPN: 8128 * - SPN: 8128
* - Data Length: 1 byte * - Data Length: 1 byte
* - Range: 0 to 250
* *
* @hdop: Horizontal dilution of precision * @hdop: Horizontal dilution of precision
* - SPN: 8129 * - SPN: 8129
* - Data Length: 1 byte * - Data Length: 1 byte
* - Resolution: 0.1 * - Resolution: 0.1
* - Range: 0.0 to 25.0
* *
* @vdop: Vertical dilution of precision * @vdop: Vertical dilution of precision
* - SPN: 8130 * - SPN: 8130
* - Data Length: 1 byte * - Data Length: 1 byte
* - Resolution: 0.1 * - Resolution: 0.1
* - Range: 0.0 to 25.0
* *
* @pdop: Position dilution of precision * @pdop: Position dilution of precision
* - SPN: 8131 * - SPN: 8131
* - Data Length: 1 byte * - Data Length: 1 byte
* - Resolution: 0.1 * - Resolution: 0.1
* - Range: 0.0 to 25.0
* *
* @tdop: Time dilution of precision * @tdop: Time dilution of precision
* - SPN: 8132 * - SPN: 8132
* - Data Length: 1 byte * - Data Length: 1 byte
* - Resolution: 0.1 * - Resolution: 0.1
* - Range: 0.0 to 25.0
* *
* This structure defines each component of the Vehicle Position 2 as described * This structure defines each component of the Vehicle Position 2 as described
* in PGN 64502. * in PGN 64502.
@@ -181,9 +178,6 @@ struct j1939_vp2_packet {
uint8_t vdop; /* SPN 8130 */ uint8_t vdop; /* SPN 8130 */
uint8_t pdop; /* SPN 8131 */ uint8_t pdop; /* SPN 8131 */
uint8_t tdop; /* SPN 8132 */ uint8_t tdop; /* SPN 8132 */
uint8_t unused5; /* Always 0xFF */
uint8_t unused6; /* Always 0xFF */
uint8_t unused7; /* Always 0xFF */
} __attribute__((__packed__)); } __attribute__((__packed__));
/** /**
@@ -270,12 +270,6 @@ static int j1939_vp2_get_data(struct j1939_vp_srv_priv *priv,
j1939_vp2_set_pdop(vp2p, pdop); j1939_vp2_set_pdop(vp2p, pdop);
j1939_vp2_set_tdop(vp2p, tdop); j1939_vp2_set_tdop(vp2p, tdop);
/* This PG's last 3 bytes are not assigned and hence must be set
* to 0xFF as per J1939-71, section 5.2 */
vp2p->unused5 = 0xFF;
vp2p->unused6 = 0xFF;
vp2p->unused7 = 0xFF;
return 0; return 0;
} }
+13 -19
View File
@@ -155,7 +155,7 @@ int hexstring2data(char *arg, unsigned char *data, int maxdlen)
return 0; return 0;
} }
int parse_canframe(char *cs, union cfu *cu) int parse_canframe(char *cs, cu_t *cu)
{ {
/* documentation see lib.h */ /* documentation see lib.h */
@@ -170,23 +170,21 @@ int parse_canframe(char *cs, union cfu *cu)
memset(cu, 0, sizeof(*cu)); /* init CAN CC/FD/XL frame, e.g. LEN = 0 */ memset(cu, 0, sizeof(*cu)); /* init CAN CC/FD/XL frame, e.g. LEN = 0 */
if (len >= 4 && cs[3] == CANID_DELIM) { /* 3 digits SFF CAN ID */ if (len < 4)
return 0;
idx = 4; /* start of frame data */ if (cs[3] == CANID_DELIM) { /* 3 digits SFF */
/* get 3 digits SFF CAN ID value */ idx = 4;
for (i = 0; i < 3; i++) { for (i = 0; i < 3; i++) {
if ((tmp = asc2nibble(cs[i])) > 0x0F) if ((tmp = asc2nibble(cs[i])) > 0x0F)
return 0; return 0;
cu->cc.can_id |= tmp << (2 - i) * 4; cu->cc.can_id |= tmp << (2 - i) * 4;
} }
} else if (len >= 21 && cs[5] == CANID_DELIM && cs[20] == CANID_DELIM) { } else if (cs[5] == CANID_DELIM) { /* 5 digits CAN XL VCID/PRIO*/
/* 5 digits CAN XL VCID/PRIO - but also check for 2nd '#' here */
idx = 6; /* start of CAN XL frame extra content (AF, SDT, etc) */ idx = 6;
/* get 5 digits CAN XL VCID/PRIO */
for (i = 0; i < 5; i++) { for (i = 0; i < 5; i++) {
if ((tmp = asc2nibble(cs[i])) > 0x0F) if ((tmp = asc2nibble(cs[i])) > 0x0F)
return 0; return 0;
@@ -198,11 +196,9 @@ int parse_canframe(char *cs, union cfu *cu)
cu->xl.prio &= CANXL_PRIO_MASK; cu->xl.prio &= CANXL_PRIO_MASK;
cu->xl.prio |= tmp; cu->xl.prio |= tmp;
} else if (len >= 9 && cs[8] == CANID_DELIM) { /* 8 digits EFF CAN ID */ } else if (cs[8] == CANID_DELIM) { /* 8 digits EFF */
idx = 9; /* start of frame data */ idx = 9;
/* get 8 digits EFF CAN ID value */
for (i = 0; i < 8; i++) { for (i = 0; i < 8; i++) {
if ((tmp = asc2nibble(cs[i])) > 0x0F) if ((tmp = asc2nibble(cs[i])) > 0x0F)
return 0; return 0;
@@ -243,12 +239,11 @@ int parse_canframe(char *cs, union cfu *cu)
cu->fd.flags |= CANFD_FDF; /* dual-use */ cu->fd.flags |= CANFD_FDF; /* dual-use */
idx += 2; idx += 2;
} else if (idx == 6) { /* CAN XL frame extra content '#80:00:11223344#' */ } else if (cs[idx + 14] == CANID_DELIM) { /* CAN XL frame '#80:00:11223344#' */
maxdlen = CANXL_MAX_DLEN; maxdlen = CANXL_MAX_DLEN;
mtu = CANXL_MTU; mtu = CANXL_MTU;
data = cu->xl.data; /* overwrite pointer to CAN XL data */ data = cu->xl.data; /* fill CAN XL data */
/* get CAN XL frame extra content */
if ((cs[idx + 2] != XL_HDR_DELIM) || (cs[idx + 5] != XL_HDR_DELIM)) if ((cs[idx + 2] != XL_HDR_DELIM) || (cs[idx + 5] != XL_HDR_DELIM))
return 0; return 0;
@@ -282,7 +277,6 @@ int parse_canframe(char *cs, union cfu *cu)
idx++; /* skip CANID_DELIM */ idx++; /* skip CANID_DELIM */
} }
/* copy CAN frame data content */
for (i = 0, dlen = 0; i < maxdlen; i++) { for (i = 0, dlen = 0; i < maxdlen; i++) {
if (cs[idx] == DATA_SEPERATOR) /* skip (optional) separator */ if (cs[idx] == DATA_SEPERATOR) /* skip (optional) separator */
idx++; idx++;
@@ -315,7 +309,7 @@ int parse_canframe(char *cs, union cfu *cu)
return mtu; return mtu;
} }
int snprintf_canframe(char *buf, size_t size, union cfu *cu, int sep) int snprintf_canframe(char *buf, size_t size, cu_t *cu, int sep)
{ {
/* documentation see lib.h */ /* documentation see lib.h */
@@ -439,7 +433,7 @@ int snprintf_canframe(char *buf, size_t size, union cfu *cu, int sep)
return offset; return offset;
} }
int snprintf_long_canframe(char *buf, size_t size, union cfu *cu, int view) int snprintf_long_canframe(char *buf, size_t size, cu_t *cu, int view)
{ {
/* documentation see lib.h */ /* documentation see lib.h */
+5 -5
View File
@@ -59,11 +59,11 @@ static inline int pr_debug(const char* fmt, ...) {return 0;}
#endif #endif
/* CAN CC/FD/XL frame union */ /* CAN CC/FD/XL frame union */
union cfu { typedef union {
struct can_frame cc; struct can_frame cc;
struct canfd_frame fd; struct canfd_frame fd;
struct canxl_frame xl; struct canxl_frame xl;
}; } cu_t;
/* /*
* The buffer size for ASCII CAN frame string representations * The buffer size for ASCII CAN frame string representations
@@ -110,7 +110,7 @@ int hexstring2data(char *arg, unsigned char *data, int maxdlen);
* *
*/ */
int parse_canframe(char *cs, union cfu *cu); int parse_canframe(char *cs, cu_t *cu);
/* /*
* Transfers a valid ASCII string describing a CAN frame into the CAN union * Transfers a valid ASCII string describing a CAN frame into the CAN union
* containing CAN CC/FD/XL structs. * containing CAN CC/FD/XL structs.
@@ -180,7 +180,7 @@ int parse_canframe(char *cs, union cfu *cu);
* - CAN FD frames do not have a RTR bit * - CAN FD frames do not have a RTR bit
*/ */
int snprintf_canframe(char *buf, size_t size, union cfu *cu, int sep); int snprintf_canframe(char *buf, size_t size, cu_t *cu, int sep);
/* /*
* Creates a CAN frame hexadecimal output in compact format. * Creates a CAN frame hexadecimal output in compact format.
* The CAN data[] is separated by '.' when sep != 0. * The CAN data[] is separated by '.' when sep != 0.
@@ -213,7 +213,7 @@ int snprintf_canframe(char *buf, size_t size, union cfu *cu, int sep);
#define SWAP_DELIMITER '`' #define SWAP_DELIMITER '`'
int snprintf_long_canframe(char *buf, size_t size, union cfu *cu, int view); int snprintf_long_canframe(char *buf, size_t size, cu_t *cu, int view);
/* /*
* Creates a CAN frame hexadecimal output in user readable format. * Creates a CAN frame hexadecimal output in user readable format.
* *
+2 -2
View File
@@ -183,7 +183,7 @@ static void canfd_asc(struct canfd_frame *cf, int devno, int mtu,
fprintf(outfile, " %8d %4d %8X 0 0 0 0 0", 130000, 130, flags); fprintf(outfile, " %8d %4d %8X 0 0 0 0 0", 130000, 130, flags);
} }
static void canxl_asc(union cfu *cu, int devno, int mtu, static void canxl_asc(cu_t *cu, int devno, int mtu,
char *extra_info, FILE *outfile) char *extra_info, FILE *outfile)
{ {
char id[10]; char id[10];
@@ -314,7 +314,7 @@ int main(int argc, char **argv)
{ {
static char buf[BUFSZ], device[DEVSZ], afrbuf[AFRSZ], extra_info[EXTRASZ]; static char buf[BUFSZ], device[DEVSZ], afrbuf[AFRSZ], extra_info[EXTRASZ];
static union cfu cu; static cu_t cu;
static struct timeval tv, start_tv; static struct timeval tv, start_tv;
FILE *infile = stdin; FILE *infile = stdin;
FILE *outfile = stdout; FILE *outfile = stdout;
+1 -1
View File
@@ -68,7 +68,7 @@
int main(void) int main(void)
{ {
static char buf[BUFSZ], timestamp[TIMESZ], device[DEVSZ], afrbuf[AFRSZ]; static char buf[BUFSZ], timestamp[TIMESZ], device[DEVSZ], afrbuf[AFRSZ];
static union cfu cu; static cu_t cu;
int mtu; int mtu;
while (fgets(buf, BUFSZ-1, stdin)) { while (fgets(buf, BUFSZ-1, stdin)) {
+2 -1
View File
@@ -72,7 +72,8 @@ int mcp251xfd_regmap_read(struct mcp251xfd_priv *priv,
return 0; return 0;
/* maybe it's something like "spi0.0" */ /* maybe it's something like "spi0.0" */
if (strchr(file_path, '/')) tmp = strchr(file_path, '/');
if (tmp)
return -ENOENT; return -ENOENT;
/* first try literally */ /* first try literally */