static void execute_service ( DIS_PACKET *  packet, DIC_SERVICE *  servp, int  size  )

static

Definition at line 376 of file dic.c.

References buffer, copy_swap_buffer_in(), DIS_HEADER, DIS_STAMPED_HEADER, FORMAT_STR::flags, dic_serv::format, dic_serv::format_data, Memory::free(), Memory::malloc(), MAX_NAME, FORMAT_STR::par_bytes, dic_serv::quality, dic_serv::serv_address, dic_serv::serv_size, dic_serv::stamped, dic_serv::tag, dic_serv::time_stamp, and dic_serv::user_routine.

Referenced by recv_rout().

{
        int format;
        FORMAT_STR format_data_cp[MAX_NAME/4], *formatp;
        static int *buffer;
        static int buffer_size = 0;
        int add_size;
        int *pkt_buffer, header_size;

        Current_server = servp;
        format = servp->format;
        memcpy(format_data_cp, servp->format_data, sizeof(format_data_cp));
        if((format & 0xF) == ((MY_FORMAT) & 0xF)) 
        {
                for(formatp = format_data_cp; formatp->par_bytes; formatp++)
                        formatp->flags &= (short)0xFFF0;    /* NOSWAP */
        }
        if( servp->stamped)
        {
                pkt_buffer = ((DIS_STAMPED_PACKET *)packet)->buffer;
                header_size = DIS_STAMPED_HEADER;
                servp->time_stamp[0] = vtohl(((DIS_STAMPED_PACKET *)packet)->time_stamp[0]);
                if(((unsigned)servp->time_stamp[0] & 0xFFFF0000) == 0xc0de0000)
                {
/*
                        servp->time_stamp[0] &= 0x0000FFFF;
*/
                        servp->time_stamp[1] = vtohl(((DIS_STAMPED_PACKET *)packet)->time_stamp[1]);
                        servp->quality = vtohl(((DIS_STAMPED_PACKET *)packet)->quality);
                }
                else if((vtohl(((DIS_STAMPED_PACKET *)packet)->reserved[0])) == (int)0xc0dec0de)
                {
/*
                        servp->time_stamp[0] &= 0x0000FFFF;
*/
                        servp->time_stamp[1] = vtohl(((DIS_STAMPED_PACKET *)packet)->time_stamp[1]);
                        servp->quality = vtohl(((DIS_STAMPED_PACKET *)packet)->quality);
                }
                else
                {
                        pkt_buffer = ((DIS_PACKET *)packet)->buffer;
                        header_size = DIS_HEADER;
                }
        }
        else
        {
                pkt_buffer = ((DIS_PACKET *)packet)->buffer;
                header_size = DIS_HEADER;
        }
        size -= header_size;
        if( servp->serv_address ) 
        {
                if( size > servp->serv_size ) 
                        size = servp->serv_size; 
                add_size = copy_swap_buffer_in(format_data_cp, 
                                                 servp->serv_address, 
                                                 pkt_buffer, size);
                if( servp->user_routine )
                        (servp->user_routine)(&servp->tag, servp->serv_address, &add_size );
        } 
        else 
        {
                if( servp->user_routine )
                {
                        add_size = size + (size/2);
                        if(!buffer_size)
                        {
                                buffer = (int *)malloc((size_t)add_size);
                                buffer_size = add_size;
                        } 
                        else 
                        {
                                if( add_size > buffer_size ) 
                                {
                                        free(buffer);
                                        buffer = (int *)malloc((size_t)add_size);
                                        buffer_size = add_size;
                                }
                        }
                        add_size = copy_swap_buffer_in(format_data_cp, 
                                                 buffer, 
                                                 pkt_buffer, size);
                        (servp->user_routine)( &servp->tag, buffer, &add_size );
                }
        }
        Current_server = 0;
}

Here is the call graph for this function:

Here is the caller graph for this function: