mtp: Print a TFP message on the screen when we get a message
This commit is contained in:
parent
3a80cb2593
commit
ae7418177e
|
@ -18,6 +18,12 @@ Eval [
|
||||||
datagram data: msg.
|
datagram data: msg.
|
||||||
socket nextPut: datagram.
|
socket nextPut: datagram.
|
||||||
|
|
||||||
|
"TFP"
|
||||||
|
msg := #(2 0 0 1 0 0 0 0 0 0 0 8
|
||||||
|
192 232 197 7 0 20 62 2) asByteArray.
|
||||||
|
datagram data: msg.
|
||||||
|
socket nextPut: datagram.
|
||||||
|
|
||||||
"TRA"
|
"TRA"
|
||||||
msg := #(2 0 0 1 0 0 0 0 0 0 0 6 192 232 197 7 0 23) asByteArray.
|
msg := #(2 0 0 1 0 0 0 0 0 0 0 6 192 232 197 7 0 23) asByteArray.
|
||||||
datagram data: msg.
|
datagram data: msg.
|
||||||
|
|
|
@ -288,6 +288,7 @@ static int mtp_link_sign_msg(struct mtp_link *link, struct mtp_level_3_hdr *hdr,
|
||||||
{
|
{
|
||||||
struct msgb *msg;
|
struct msgb *msg;
|
||||||
struct mtp_level_3_cmn *cmn;
|
struct mtp_level_3_cmn *cmn;
|
||||||
|
uint16_t *apc;
|
||||||
|
|
||||||
if (hdr->ni != link->ni || l3_len < 1) {
|
if (hdr->ni != link->ni || l3_len < 1) {
|
||||||
LOGP(DINP, LOGL_ERROR, "Unhandled data (ni: %d len: %d)\n",
|
LOGP(DINP, LOGL_ERROR, "Unhandled data (ni: %d len: %d)\n",
|
||||||
|
@ -321,6 +322,21 @@ static int mtp_link_sign_msg(struct mtp_link *link, struct mtp_level_3_hdr *hdr,
|
||||||
break;
|
break;
|
||||||
}
|
}
|
||||||
break;
|
break;
|
||||||
|
case MTP_PROHIBIT_MSG_GRP:
|
||||||
|
switch (cmn->h1) {
|
||||||
|
case MTP_PROHIBIT_MSG_SIG:
|
||||||
|
if (l3_len < 3) {
|
||||||
|
LOGP(DINP, LOGL_ERROR, "TFP is too short.\n");
|
||||||
|
return -1;
|
||||||
|
}
|
||||||
|
|
||||||
|
apc = (uint16_t *) &hdr->data[1];
|
||||||
|
LOGP(DINP, LOGL_INFO,
|
||||||
|
"TFP for the affected point code: %d\n", *apc);
|
||||||
|
return 0;
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
break;
|
||||||
}
|
}
|
||||||
|
|
||||||
LOGP(DINP, LOGL_ERROR, "Unknown message:%d/%d %s\n", cmn->h0, cmn->h1, hexdump(&hdr->data[0], l3_len));
|
LOGP(DINP, LOGL_ERROR, "Unknown message:%d/%d %s\n", cmn->h0, cmn->h1, hexdump(&hdr->data[0], l3_len));
|
||||||
|
|
Reference in New Issue