Lines Matching defs:cmsg
415 #define TYP (cdef[cmsg->par[cmsg->p]].typ)
416 #define OFF (((u8 *)cmsg)+cdef[cmsg->par[cmsg->p]].off)
418 static void jumpcstruct(_cmsg * cmsg)
421 for (cmsg->p++, layer = 1; layer;) {
422 /* $$$$$ assert (cmsg->p); */
423 cmsg->p++;
435 static void pars_2_message(_cmsg * cmsg)
438 for (; TYP != _CEND; cmsg->p++) {
441 byteTLcpy(cmsg->m + cmsg->l, OFF);
442 cmsg->l++;
445 wordTLcpy(cmsg->m + cmsg->l, OFF);
446 cmsg->l += 2;
449 dwordTLcpy(cmsg->m + cmsg->l, OFF);
450 cmsg->l += 4;
454 *(cmsg->m + cmsg->l) = '\0';
455 cmsg->l++;
457 structTLcpy(cmsg->m + cmsg->l, *(_cstruct *) OFF, 1 + **(_cstruct *) OFF);
458 cmsg->l += 1 + **(_cstruct *) OFF;
461 structTLcpy(cmsg->m + cmsg->l, s, 3 + *(u16 *) (s + 1));
462 cmsg->l += 3 + *(u16 *) (s + 1);
468 *(cmsg->m + cmsg->l) = '\0';
469 cmsg->l++;
470 jumpcstruct(cmsg);
474 unsigned _l = cmsg->l;
476 cmsg->l++;
477 cmsg->p++;
478 pars_2_message(cmsg);
479 _ls = cmsg->l - _l - 1;
481 (cmsg->m + _l)[0] = (u8) _ls;
483 structTLcpyovl(cmsg->m + _l + 3, cmsg->m + _l + 1, _ls);
484 (cmsg->m + _l)[0] = 0xff;
485 wordTLcpy(cmsg->m + _l + 1, &_ls);
494 unsigned capi_cmsg2message(_cmsg * cmsg, u8 * msg)
496 cmsg->m = msg;
497 cmsg->l = 8;
498 cmsg->p = 0;
499 cmsg->par = cpars[command_2_index(cmsg->Command, cmsg->Subcommand)];
501 pars_2_message(cmsg);
503 wordTLcpy(msg + 0, &cmsg->l);
504 byteTLcpy(cmsg->m + 4, &cmsg->Command);
505 byteTLcpy(cmsg->m + 5, &cmsg->Subcommand);
506 wordTLcpy(cmsg->m + 2, &cmsg->ApplId);
507 wordTLcpy(cmsg->m + 6, &cmsg->Messagenumber);
513 static void message_2_pars(_cmsg * cmsg)
515 for (; TYP != _CEND; cmsg->p++) {
519 byteTRcpy(cmsg->m + cmsg->l, OFF);
520 cmsg->l++;
523 wordTRcpy(cmsg->m + cmsg->l, OFF);
524 cmsg->l += 2;
527 dwordTRcpy(cmsg->m + cmsg->l, OFF);
528 cmsg->l += 4;
531 *(u8 **) OFF = cmsg->m + cmsg->l;
533 if (cmsg->m[cmsg->l] != 0xff)
534 cmsg->l += 1 + cmsg->m[cmsg->l];
536 cmsg->l += 3 + *(u16 *) (cmsg->m + cmsg->l + 1);
540 if (cmsg->m[cmsg->l] == '\0') {
542 cmsg->l++;
543 jumpcstruct(cmsg);
545 unsigned _l = cmsg->l;
547 cmsg->l = (cmsg->m + _l)[0] == 255 ? cmsg->l + 3 : cmsg->l + 1;
548 cmsg->p++;
549 message_2_pars(cmsg);
557 unsigned capi_message2cmsg(_cmsg * cmsg, u8 * msg)
559 memset(cmsg, 0, sizeof(_cmsg));
560 cmsg->m = msg;
561 cmsg->l = 8;
562 cmsg->p = 0;
563 byteTRcpy(cmsg->m + 4, &cmsg->Command);
564 byteTRcpy(cmsg->m + 5, &cmsg->Subcommand);
565 cmsg->par = cpars[command_2_index(cmsg->Command, cmsg->Subcommand)];
567 message_2_pars(cmsg);
569 wordTRcpy(msg + 0, &cmsg->l);
570 wordTRcpy(cmsg->m + 2, &cmsg->ApplId);
571 wordTRcpy(cmsg->m + 6, &cmsg->Messagenumber);
577 unsigned capi_cmsg_header(_cmsg * cmsg, u16 _ApplId,
581 memset(cmsg, 0, sizeof(_cmsg));
582 cmsg->ApplId = _ApplId;
583 cmsg->Command = _Command;
584 cmsg->Subcommand = _Subcommand;
585 cmsg->Messagenumber = _Messagenumber;
586 cmsg->adr.adrController = _Controller;
792 #define NAME (pnames[cmsg->par[cmsg->p]])
794 static _cdebbuf *protocol_message_2_pars(_cdebbuf *cdb, _cmsg *cmsg, int level)
796 for (; TYP != _CEND; cmsg->p++) {
808 cdb = bufprint(cdb, "%-*s = 0x%x\n", slen, NAME, *(u8 *) (cmsg->m + cmsg->l));
809 cmsg->l++;
812 cdb = bufprint(cdb, "%-*s = 0x%x\n", slen, NAME, *(u16 *) (cmsg->m + cmsg->l));
813 cmsg->l += 2;
816 cdb = bufprint(cdb, "%-*s = 0x%lx\n", slen, NAME, *(u32 *) (cmsg->m + cmsg->l));
817 cmsg->l += 4;
821 if (cmsg->m[cmsg->l] == '\0')
824 cdb = printstruct(cdb, cmsg->m + cmsg->l);
826 if (cmsg->m[cmsg->l] != 0xff)
827 cmsg->l += 1 + cmsg->m[cmsg->l];
829 cmsg->l += 3 + *(u16 *) (cmsg->m + cmsg->l + 1);
835 if (cmsg->m[cmsg->l] == '\0') {
837 cmsg->l++;
838 jumpcstruct(cmsg);
841 unsigned _l = cmsg->l;
843 cmsg->l = (cmsg->m + _l)[0] == 255 ? cmsg->l + 3 : cmsg->l + 1;
844 cmsg->p++;
845 cdb = protocol_message_2_pars(cdb, cmsg, level + 1);
897 _cmsg *cmsg;
903 cmsg = g_cmsg;
905 cmsg = kmalloc(sizeof(_cmsg), GFP_ATOMIC);
906 if (unlikely(!cmsg)) {
910 cmsg->m = msg;
911 cmsg->l = 8;
912 cmsg->p = 0;
913 byteTRcpy(cmsg->m + 4, &cmsg->Command);
914 byteTRcpy(cmsg->m + 5, &cmsg->Subcommand);
915 cmsg->par = cpars[command_2_index(cmsg->Command, cmsg->Subcommand)];
918 mnames[command_2_index(cmsg->Command, cmsg->Subcommand)],
923 cdb = protocol_message_2_pars(cdb, cmsg, 1);
924 if (unlikely(cmsg != g_cmsg))
925 kfree(cmsg);
929 _cdebbuf *capi_cmsg2str(_cmsg * cmsg)
936 cmsg->l = 8;
937 cmsg->p = 0;
939 mnames[command_2_index(cmsg->Command, cmsg->Subcommand)],
940 ((u16 *) cmsg->m)[1],
941 ((u16 *) cmsg->m)[3],
942 ((u16 *) cmsg->m)[0]);
943 cdb = protocol_message_2_pars(cdb, cmsg, 1);
987 _cdebbuf *capi_cmsg2str(_cmsg * cmsg)