Compare commits
5 Commits
51056e9acf
...
2b66a26d4c
| Author | SHA1 | Date |
|---|---|---|
|
|
2b66a26d4c | |
|
|
99ab67143a | |
|
|
a0aeaed234 | |
|
|
3cae8a449b | |
|
|
63500f8dd0 |
36
bcmserver.c
36
bcmserver.c
|
|
@ -153,7 +153,7 @@ int main(void)
|
||||||
|
|
||||||
char buf[MAXLEN];
|
char buf[MAXLEN];
|
||||||
char format[FORMATSZ];
|
char format[FORMATSZ];
|
||||||
char rxmsg[50];
|
char rxmsg[64];
|
||||||
|
|
||||||
#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,6 +242,8 @@ int main(void)
|
||||||
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);
|
||||||
|
|
@ -249,17 +251,35 @@ int main(void)
|
||||||
ifr.ifr_ifindex = caddr.can_ifindex;
|
ifr.ifr_ifindex = caddr.can_ifindex;
|
||||||
ioctl(sc, SIOCGIFNAME, &ifr);
|
ioctl(sc, SIOCGIFNAME, &ifr);
|
||||||
|
|
||||||
sprintf(rxmsg, "< %s %03X %d ", ifr.ifr_name,
|
res = snprintf(rxmsg, size, "< %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;
|
||||||
|
}
|
||||||
|
|
||||||
for ( i = 0; i < msg.frame.can_dlc; i++)
|
len += res;
|
||||||
sprintf(rxmsg + strlen(rxmsg), "%02X ",
|
|
||||||
msg.frame.data[i]);
|
for (i = 0; i < msg.frame.can_dlc; 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 */
|
||||||
strcat(rxmsg, ">\0");
|
res = snprintf(rxmsg + len, size - len, ">");
|
||||||
|
if (res < 0 || (size_t)res >= (size - len)) {
|
||||||
|
printf("Error: rxmsg buffer (size %zu) too small for data.\n", size);
|
||||||
|
continue;
|
||||||
|
}
|
||||||
|
|
||||||
send(sa, rxmsg, strlen(rxmsg) + 1, 0);
|
len += res;
|
||||||
|
|
||||||
|
send(sa, rxmsg, len + 1, 0);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
|
||||||
|
|
|
||||||
|
|
@ -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
|
||||||
|
|
||||||
Loading…
Reference in New Issue