FreeCalypso > hg > fc-magnetite
view src/g23m-fad/tcpip/rnet/rnet_rt/rnet_rt_atp.c @ 598:717ed17d82c6
aci3 vocoder control revamped, AT@VSEL now works as it should
The vocoder control code (hl_audio_drv.c) that came with the TCS3 version
of ACI was totally broken in the Calypso config (VOCODER_FUNC_INTERFACE)
and worked in the standard analog voice environment only by luck.
This code has now been rewritten to work correctly with our Calypso
platform and TCS211 L1, and our new AT@VSEL mechanism (automatic enabling
and disabling of MCSI voice path as the modem enters and exits the voice
call state) now also works as designed.
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Wed, 27 Mar 2019 23:44:35 +0000 |
parents | 90eb61ecd093 |
children |
line wrap: on
line source
/** * @file rnet_rt_atp.c * * Coding of the ATP point-to-point network interface for RNET_RT, * * @author Regis Feneon * @version 0.1 */ /* * $Id: rnet_rt_atp.c,v 1.4 2002/12/05 10:02:19 rf Exp $ * $Name: $ * * History: * * Date Author Modification * -------------------------------------------------- * 5/6/2002 Regis Feneon Create * 6/9/2002 Regis Feneon Select default route * on local interface address if no destination address * 12/5/2002 Regis Feneon Flow control handling * (C) Copyright 2002 by TI, All Rights Reserved * */ #include "rnet_cfg.h" #ifdef RNET_CFG_REAL_TRANSPORT #include "rnet_rt_i.h" #include "rnet_trace_i.h" #include "rnet_rt_atp_i.h" #include "atp_api.h" #include "atp_messages.h" #include "rnet_atp_info.h" static int atpOpen( NGifnet *netp) { T_ATP_RET ret; T_ATP_CALLBACK return_path; T_ATP_ENTITY_MODE mode = { CMD_SUPPORT_OFF, TXT_MODE, COPY_ON }; /* interface already running ? */ if( netp->if_flags & NG_IFF_RUNNING) { RNET_RT_SEND_TRACE("RNET_RT: WINNET_open: already running",RV_TRACE_LEVEL_ERROR); return( NG_EALREADY); } /* register to ATP */ return_path.addr_id = rnet_rt_env_ctrl_blk_p->addr_id; return_path.callback_func = NULL; ret = atp_reg( (UINT8*) "RNET_RT", return_path, mode, &((T_RNET_RT_ATP_IFNET *) netp)->atp_sw_id); if( ret != RV_OK) { return( NG_ENODEV); } /* set a local port... */ ((T_RNET_RT_ATP_IFNET *) netp)->atp_port_nb = 1; netp->if_flags |= NG_IFF_RUNNING; /* use NG_IFF_OACTIVE flag for flow control */ netp->if_flags &= ~NG_IFF_OACTIVE; return( NG_EOK); } static int atpClose( NGifnet *netp) { /* interface should be running to be closed */ if( !(netp->if_flags & NG_IFF_RUNNING)) { return( NG_EALREADY); } /* clear flags */ netp->if_flags &= ~NG_IFF_RUNNING; /* deregister to ATP */ atp_dereg( ((T_RNET_RT_ATP_IFNET *) netp)->atp_sw_id); return( NG_EOK); } static int atpOutput( NGifnet *netp, NGbuf *bufp, NGuint addr) { UINT32 wlen; int err; // RNET_RT_SEND_TRACE("RNET_RT: In atpOutput",RV_TRACE_LEVEL_ERROR); /* point-to-point interfaces dont use destination address */ ((void)addr); /* Interface must be up and running */ if ( (netp->if_flags & (NG_IFF_RUNNING|NG_IFF_UP)) != (NG_IFF_RUNNING|NG_IFF_UP)) { err = NG_ENETDOWN; } else { /* send IP packet to ATP if output is on... */ /* ...else discard the packet */ if( !(netp->if_flags & NG_IFF_OACTIVE)) { atp_send_data( ((T_RNET_RT_ATP_IFNET *) netp)->atp_sw_id, ((T_RNET_RT_ATP_IFNET *) netp)->atp_port_nb, bufp->buf_datap, bufp->buf_datalen, &wlen); } err = NG_EOK; } /* release buffer */ ngBufOutputFree( bufp); return( err); } static int atpCntl( NGifnet *netp, int cmd, int opt, void *arg) { int ret; NGbuf *bufp; UINT32 rlen, left; UINT8 tmpbuf[16]; T_RNET_RT_ATP_CUSTOM_INFO *cinfo; T_ATP_NO_COPY_INFO no_copy_info = { 0 }; /* not used */ static const T_ATP_PORT_INFO info = { DATA_CONFIG, ATP_NO_RING_TYPE, // old version received from NexGen and modified 5/Dec/2002 : 0, ATP_RX_FLOW_UNMASK | ATP_TX_FLOW_UNMASK, 0 }; // RNET_RT_SEND_TRACE("RNET_RT: in atpCntl",RV_TRACE_LEVEL_ERROR); if( opt == NG_RNETIFO_HANDLE_MSG) { /* handle ATP messages */ switch( ((T_RV_HDR *)arg)->msg_id) { case ATP_OPEN_PORT_IND: RNET_RT_SEND_TRACE("RNET_RT: receive OPEN_PORT_IND",RV_TRACE_LEVEL_ERROR); cinfo = (T_RNET_RT_ATP_CUSTOM_INFO *) ((T_ATP_OPEN_PORT_IND *) arg)->custom_info_p; /* if interface is already up, or if no associated data, open is not accepted */ if( ((netp->if_flags & (NG_IFF_UP|NG_IFF_RUNNING)) != NG_IFF_RUNNING) || (cinfo == NULL)) { atp_open_port_rsp( ((T_ATP_OPEN_PORT_IND *) arg)->initiator_id, ((T_ATP_OPEN_PORT_IND *) arg)->initiator_port_nb, ((T_RNET_RT_ATP_IFNET *) netp)->atp_sw_id, ((T_RNET_RT_ATP_IFNET *) netp)->atp_port_nb, info, no_copy_info, NULL, OPEN_PORT_NOK); } else { /* send confirmation to ATP client */ ((T_RNET_RT_ATP_IFNET *) netp)->atp_client_sw_id = ((T_ATP_OPEN_PORT_IND *) arg)->initiator_id; ((T_RNET_RT_ATP_IFNET *) netp)->atp_client_port_nb = ((T_ATP_OPEN_PORT_IND *) arg)->initiator_port_nb; no_copy_info.packet_mode = NORMAL_PACKET; /* No L2CAP packet... */ no_copy_info.rx_mb = no_copy_info.tx_mb = RVF_INVALID_MB_ID; ret = atp_open_port_rsp( ((T_ATP_OPEN_PORT_IND *) arg)->initiator_id, ((T_ATP_OPEN_PORT_IND *) arg)->initiator_port_nb, ((T_RNET_RT_ATP_IFNET *) netp)->atp_sw_id, ((T_RNET_RT_ATP_IFNET *) netp)->atp_port_nb, info, no_copy_info, NULL, OPEN_PORT_OK); if( ret == RV_OK) { /* interface is ready to send and receive packets */ netp->if_flags |= NG_IFF_UP; /* set MTU */ netp->if_mtu = cinfo->mtu; /* Activating the link addresses */ ngIfGenCntl( netp, NG_CNTL_SET, NG_IFO_ADDR, &cinfo->local_addr); ngIfGenCntl( netp, NG_CNTL_SET, NG_IFO_DSTADDR, &cinfo->dest_addr); /* set default route */ if( cinfo->dest_addr == 0) { (void)(ngProto_IP.pr_cntl_f( NG_CNTL_SET, NG_IPO_ROUTE_DEFAULT, (NGuint *) &cinfo->local_addr)); } else { (void)(ngProto_IP.pr_cntl_f( NG_CNTL_SET, NG_IPO_ROUTE_DEFAULT, (NGuint *) &cinfo->dest_addr)); } /* set DNS configuration */ (void)(ngProto_RESOLV.pr_cntl_f( NG_CNTL_SET, NG_RSLVO_SERV1_IPADDR, &cinfo->dns1)); (void)(ngProto_RESOLV.pr_cntl_f( NG_CNTL_SET, NG_RSLVO_SERV2_IPADDR, &cinfo->dns2)); } } /* release custom information buffer */ if( cinfo != NULL) { atp_free_buffer( cinfo); } break; case ATP_PORT_CLOSED: RNET_RT_SEND_TRACE("RNET_RT: receive PORT_CLOSED",RV_TRACE_LEVEL_ERROR); if( (netp->if_flags & (NG_IFF_RUNNING|NG_IFF_UP)) != (NG_IFF_RUNNING|NG_IFF_UP)) { /* interface already down */ break; } /* set interface down */ netp->if_flags &= ~NG_IFF_UP; /* call ip layer */ (void)(ngProto_IP.pr_cntl_f( NG_CNTL_SET, NG_IPO_NETDOWN, netp)); break; case ATP_DATA_RDY: /* allocate buffer for receiving new packet */ RNET_RT_SEND_TRACE("RNET_RT: receive DATA_RDY",RV_TRACE_LEVEL_ERROR); ngBufAlloc( bufp); if( bufp != NULL) { /* get new data */ bufp->buf_flags |= NG_PROTO_IP; bufp->buf_datap = ((NGubyte *) bufp) + ngBufDataOffset; ret = atp_get_data( ((T_RNET_RT_ATP_IFNET *) netp)->atp_sw_id, ((T_RNET_RT_ATP_IFNET *) netp)->atp_port_nb, (UINT8 *) bufp->buf_datap, ngBufDataMax, &rlen, &left); if( (ret != RV_OK) || (rlen == 0)) { netp->if_ierrors++; ngBufFree( bufp); } else { // rnet_debug[0] = '\0' ; // for(rnet_ind=0;rnet_ind<48;rnet_ind++) { // char tmp[3] ; // sprintf(tmp, "%.2x", bufp->buf_datap[rnet_ind]); // strcat(rnet_debug, tmp) ; // } // RNET_RT_SEND_TRACE("RNET_RT: receive content",RV_TRACE_LEVEL_ERROR); // RNET_RT_SEND_TRACE(rnet_debug, RV_TRACE_LEVEL_ERROR); // rvf_delay(RVF_MS_TO_TICKS(100)); /* get length of packet */ bufp->buf_datalen = rlen; /* start IP processing */ ngIfGenInput( netp, bufp, 1); } } else { /* skip packet */ netp->if_ierrors++; atp_get_data( ((T_RNET_RT_ATP_IFNET *) netp)->atp_sw_id, ((T_RNET_RT_ATP_IFNET *) netp)->atp_port_nb, tmpbuf, sizeof( tmpbuf), &rlen, &left); } break; case ATP_SIGNAL_CHANGED: /* handle flow control flags */ RNET_RT_SEND_TRACE("RNET_RT: receive SIGNAL_CHANGED",RV_TRACE_LEVEL_ERROR); // rvf_delay(RVF_MS_TO_TICKS(1000)); if( ((T_ATP_SIGNAL_CHANGED *) arg)->mask & ATP_TX_FLOW_UNMASK) { if( ((T_ATP_SIGNAL_CHANGED *) arg)->signal & ATP_TX_FLOW_ON) { /* enable transimissions */ netp->if_flags &= ~NG_IFF_OACTIVE; } else { /* disable transmissions */ netp->if_flags |= NG_IFF_OACTIVE; } } break; default: /* unknown message */ RNET_TRACE_MEDIUM_PARAM("RNET_RT: receive default ",((T_RV_HDR *)arg)->msg_id); return( NG_EINVAL); } return( NG_EOK); } else { RNET_RT_SEND_TRACE("RNET_RT: opt not handle msg", RV_TRACE_LEVEL_ERROR); return( ngIfGenCntl( netp, cmd, opt, arg)); } } /********************************************************************/ /* Driver entry point */ const NGnetdrv rnet_rt_netdrv_atp = { "ATP", NG_IFT_PPP, NG_IFF_POINTOPOINT|NG_IFF_MULTICAST, RNET_RT_ATP_MTU, 0, NULL, atpOpen, atpClose, atpOutput, NULL, atpCntl }; #endif /* ifdef RNET_CFG_REAL_TRANSPORT */