ZLMediaKit/src/Rtsp/RtspPlayer.cpp

735 lines
23 KiB
C++
Raw Normal View History

2017-10-09 22:11:01 +08:00
/*
2017-09-27 16:20:30 +08:00
* MIT License
*
* Copyright (c) 2016 xiongziliang <771730766@qq.com>
* Copyright (c) 2018 huohuo <913481084@qq.com>
2017-09-27 16:20:30 +08:00
*
* This file is part of ZLMediaKit(https://github.com/xiongziliang/ZLMediaKit).
*
* Permission is hereby granted, free of charge, to any person obtaining a copy
* of this software and associated documentation files (the "Software"), to deal
* in the Software without restriction, including without limitation the rights
* to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
* copies of the Software, and to permit persons to whom the Software is
* furnished to do so, subject to the following conditions:
*
* The above copyright notice and this permission notice shall be included in all
* copies or substantial portions of the Software.
*
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
* IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
* FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
* AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
* LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
* OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
* SOFTWARE.
*/
2017-04-01 16:35:56 +08:00
#include <set>
#include <cmath>
#include <stdarg.h>
#include <algorithm>
2017-05-02 17:15:12 +08:00
#include "Common/config.h"
2017-04-25 11:35:41 +08:00
#include "RtspPlayer.h"
2017-04-01 16:35:56 +08:00
#include "H264/SPSParser.h"
#include "Util/MD5.h"
2017-04-25 11:35:41 +08:00
#include "Util/mini.h"
2017-08-09 18:39:30 +08:00
#include "Util/util.h"
2018-09-20 15:43:49 +08:00
#include "Util/base64.h"
2017-04-01 16:35:56 +08:00
#include "Network/sockutil.h"
2018-10-24 17:17:55 +08:00
using namespace toolkit;
2017-04-01 16:35:56 +08:00
2018-10-24 17:17:55 +08:00
namespace mediakit {
2017-04-01 16:35:56 +08:00
#define POP_HEAD(trackidx) \
2018-10-24 15:43:52 +08:00
auto it = _amapRtpSort[trackidx].begin(); \
onRecvRTP_l(it->second, trackidx); \
2018-10-24 15:43:52 +08:00
_amapRtpSort[trackidx].erase(it);
2017-04-01 16:35:56 +08:00
#define RTP_BUF_SIZE (4 * 1024)
2018-07-02 16:00:55 +08:00
const char kRtspMd5Nonce[] = "rtsp_md5_nonce";
const char kRtspRealm[] = "rtsp_realm";
2017-08-03 13:55:46 +08:00
2017-04-01 16:35:56 +08:00
RtspPlayer::RtspPlayer(void){
2018-10-24 15:43:52 +08:00
_pktPool.setSize(64);
2017-04-01 16:35:56 +08:00
}
RtspPlayer::~RtspPlayer(void) {
2018-10-30 10:31:27 +08:00
RtspPlayer::teardown();
2017-04-01 16:35:56 +08:00
DebugL<<endl;
}
void RtspPlayer::teardown(){
if (alive()) {
2018-10-24 15:43:52 +08:00
sendRtspRequest("TEARDOWN" ,_strContentBase);
2017-04-01 16:35:56 +08:00
shutdown();
}
2018-07-02 16:00:55 +08:00
erase(kRtspMd5Nonce);
erase(kRtspRealm);
2018-10-26 09:56:29 +08:00
_aTrackInfo.clear();
2018-10-24 15:43:52 +08:00
_onHandshake = nullptr;
_strSession.clear();
_uiCseq = 1;
_strContentBase.clear();
CLEAR_ARR(_apUdpSock);
CLEAR_ARR(_aui16LastSeq)
CLEAR_ARR(_aui16FirstSeq)
CLEAR_ARR(_aui32SsrcErrorCnt)
CLEAR_ARR(_aui64RtpRecv)
CLEAR_ARR(_aui64SeqOkCnt)
CLEAR_ARR(_abSortStarted)
CLEAR_ARR(_aui64RtpRecv)
CLEAR_ARR(_aui16NowSeq)
_amapRtpSort[0].clear();
_amapRtpSort[1].clear();
_pBeatTimer.reset();
_pPlayTimer.reset();
_pRtpTimer.reset();
2018-10-26 14:12:16 +08:00
_iSeekTo = 0;
CLEAR_ARR(_aiFistStamp);
CLEAR_ARR(_aiNowStamp);
2017-04-01 16:35:56 +08:00
}
2017-08-03 13:55:46 +08:00
void RtspPlayer::play(const char* strUrl){
auto userAndPwd = FindField(strUrl,"://","@");
eRtpType eType = (eRtpType)(int)(*this)[kRtpType];
if(userAndPwd.empty()){
play(strUrl,nullptr,nullptr,eType);
return;
}
auto suffix = FindField(strUrl,"@",nullptr);
auto url = StrPrinter << "rtsp://" << suffix << endl;
if(userAndPwd.find(":") == string::npos){
play(url.data(),userAndPwd.data(),nullptr,eType);
return;
}
auto user = FindField(userAndPwd.data(),nullptr,":");
auto pwd = FindField(userAndPwd.data(),":",nullptr);
play(url.data(),user.data(),pwd.data(),eType);
}
2017-04-01 16:35:56 +08:00
//播放指定是否走rtp over tcp
void RtspPlayer::play(const char* strUrl, const char *strUser, const char *strPwd, eRtpType eType ) {
2017-08-03 13:55:46 +08:00
DebugL << strUrl << " "
<< (strUser ? strUser : "null") << " "
<< (strPwd ? strPwd:"null") << " "
<< eType;
2017-04-01 16:35:56 +08:00
teardown();
if(strUser){
(*this)[kRtspUser] = strUser;
}
if(strPwd){
(*this)[kRtspPwd] = strPwd;
(*this)[kRtspPwdIsMD5] = false;
2017-04-01 16:35:56 +08:00
}
2018-10-24 15:43:52 +08:00
_eType = eType;
2018-10-30 10:31:27 +08:00
2017-04-01 16:35:56 +08:00
auto ip = FindField(strUrl, "://", "/");
if (!ip.size()) {
ip = FindField(strUrl, "://", NULL);
}
auto port = atoi(FindField(ip.c_str(), ":", NULL).c_str());
if (port <= 0) {
//rtsp 默认端口554
port = 554;
} else {
//服务器域名
ip = FindField(ip.c_str(), NULL, ":");
}
2018-10-24 15:43:52 +08:00
_strUrl = strUrl;
2018-05-21 23:18:17 +08:00
if(!(*this)[PlayerBase::kNetAdapter].empty()){
setNetAdapter((*this)[PlayerBase::kNetAdapter]);
}
2017-04-01 16:35:56 +08:00
startConnect(ip.data(), port);
}
void RtspPlayer::onConnect(const SockException &err){
if(err.getErrCode()!=Err_success) {
onPlayResult_l(err);
2017-04-01 16:35:56 +08:00
teardown();
return;
}
sendDescribe();
2017-04-01 16:35:56 +08:00
weak_ptr<RtspPlayer> weakSelf = dynamic_pointer_cast<RtspPlayer>(shared_from_this());
2018-10-24 15:43:52 +08:00
_pPlayTimer.reset( new Timer(10, [weakSelf]() {
2017-04-01 16:35:56 +08:00
auto strongSelf=weakSelf.lock();
if(!strongSelf) {
return false;
}
strongSelf->onPlayResult_l(SockException(Err_timeout,"play rtsp timeout"));
2017-04-01 16:35:56 +08:00
strongSelf->teardown();
return false;
2018-09-14 18:04:41 +08:00
},getExecutor()));
2017-04-01 16:35:56 +08:00
}
2018-02-23 15:36:51 +08:00
void RtspPlayer::onRecv(const Buffer::Ptr& pBuf) {
2018-10-30 10:31:27 +08:00
input(pBuf->data(),pBuf->size());
2017-04-01 16:35:56 +08:00
}
void RtspPlayer::onErr(const SockException &ex) {
onShutdown_l (ex);
2017-04-01 16:35:56 +08:00
}
// from live555
bool RtspPlayer::handleAuthenticationFailure(const string &paramsStr) {
if(!(*this)[kRtspRealm].empty()){
//已经认证过了
return false;
}
2018-07-05 22:05:09 +08:00
char *realm = new char[paramsStr.size()];
char *nonce = new char[paramsStr.size()];
char *stale = new char[paramsStr.size()];
onceToken token(nullptr,[&](){
delete[] realm;
delete[] nonce;
delete[] stale;
});
if (sscanf(paramsStr.data(), "Digest realm=\"%[^\"]\", nonce=\"%[^\"]\", stale=%[a-zA-Z]", realm, nonce, stale) == 3) {
2018-07-05 22:05:09 +08:00
(*this)[kRtspRealm] = (const char *)realm;
(*this)[kRtspMd5Nonce] = (const char *)nonce;
return true;
}
if (sscanf(paramsStr.data(), "Digest realm=\"%[^\"]\", nonce=\"%[^\"]\"", realm, nonce) == 2) {
2018-07-05 22:05:09 +08:00
(*this)[kRtspRealm] = (const char *)realm;
(*this)[kRtspMd5Nonce] = (const char *)nonce;
return true;
}
if (sscanf(paramsStr.data(), "Basic realm=\"%[^\"]\"", realm) == 1) {
2018-07-05 22:05:09 +08:00
(*this)[kRtspRealm] = (const char *)realm;
return true;
}
return false;
}
void RtspPlayer::handleResDESCRIBE(const Parser& parser) {
string authInfo = parser["WWW-Authenticate"];
2017-04-01 16:35:56 +08:00
//发送DESCRIBE命令后的回复
if ((parser.Url() == "401") && handleAuthenticationFailure(authInfo)) {
sendDescribe();
return;
}
2017-04-01 16:35:56 +08:00
if (parser.Url() != "200") {
throw std::runtime_error(
StrPrinter << "DESCRIBE:" << parser.Url() << " " << parser.Tail() << endl);
}
2018-10-24 15:43:52 +08:00
_strContentBase = parser["Content-Base"];
2018-10-24 15:43:52 +08:00
if(_strContentBase.empty()){
_strContentBase = _strUrl;
}
2018-10-24 15:43:52 +08:00
if (_strContentBase.back() == '/') {
_strContentBase.pop_back();
}
2017-04-01 16:35:56 +08:00
//解析sdp
2018-10-30 10:31:27 +08:00
_sdpAttr.load(parser.Content());
2018-10-26 09:56:29 +08:00
_aTrackInfo = _sdpAttr.getAvailableTrack();
if (_aTrackInfo.empty()) {
2018-10-26 10:12:37 +08:00
throw std::runtime_error("无有效的Sdp Track");
2017-04-01 16:35:56 +08:00
}
2018-10-30 10:31:27 +08:00
if (!onCheckSDP(parser.Content(), _sdpAttr)) {
2017-04-01 16:35:56 +08:00
throw std::runtime_error("onCheckSDP faied");
}
2018-10-26 09:56:29 +08:00
CLEAR_ARR(_aui32SsrcErrorCnt)
2017-04-01 16:35:56 +08:00
sendSetup(0);
}
//发送SETUP命令
bool RtspPlayer::sendSetup(unsigned int trackIndex) {
2018-10-24 15:43:52 +08:00
_onHandshake = std::bind(&RtspPlayer::handleResSETUP,this, placeholders::_1,trackIndex);
2018-10-24 15:43:52 +08:00
auto &track = _aTrackInfo[trackIndex];
2018-10-26 09:56:29 +08:00
auto baseUrl = _strContentBase + "/" + track->_control_surffix;
2018-10-24 15:43:52 +08:00
switch (_eType) {
case RTP_TCP: {
StrCaseMap header;
2018-10-26 10:59:13 +08:00
header["Transport"] = StrPrinter << "RTP/AVP/TCP;unicast;interleaved=" << track->_type * 2 << "-" << track->_type * 2 + 1;
return sendRtspRequest("SETUP",baseUrl,header);
2017-04-01 16:35:56 +08:00
}
break;
case RTP_MULTICAST: {
StrCaseMap header;
header["Transport"] = "Transport: RTP/AVP;multicast";
return sendRtspRequest("SETUP",baseUrl,header);
}
break;
case RTP_UDP: {
2018-10-24 15:43:52 +08:00
_apUdpSock[trackIndex].reset(new Socket());
if (!_apUdpSock[trackIndex]->bindUdpSock(0, get_local_ip().data())) {
_apUdpSock[trackIndex].reset();
throw std::runtime_error("open udp sock err");
}
2018-10-24 15:43:52 +08:00
int port = _apUdpSock[trackIndex]->get_local_port();
StrCaseMap header;
header["Transport"] = StrPrinter << "RTP/AVP;unicast;client_port=" << port << "-" << port + 1;
return sendRtspRequest("SETUP",baseUrl,header);
}
break;
default:
return false;
break;
2017-04-01 16:35:56 +08:00
}
}
void RtspPlayer::handleResSETUP(const Parser &parser, unsigned int uiTrackIndex) {
2017-04-01 16:35:56 +08:00
if (parser.Url() != "200") {
throw std::runtime_error(
StrPrinter << "SETUP:" << parser.Url() << " " << parser.Tail() << endl);
}
if (uiTrackIndex == 0) {
2018-10-24 15:43:52 +08:00
_strSession = parser["Session"];
_strSession.append(";");
_strSession = FindField(_strSession.data(), nullptr, ";");
2017-04-01 16:35:56 +08:00
}
auto strTransport = parser["Transport"];
if(strTransport.find("TCP") != string::npos){
2018-10-24 15:43:52 +08:00
_eType = RTP_TCP;
2017-04-01 16:35:56 +08:00
}else if(strTransport.find("multicast") != string::npos){
2018-10-24 15:43:52 +08:00
_eType = RTP_MULTICAST;
2017-04-01 16:35:56 +08:00
}else{
2018-10-24 15:43:52 +08:00
_eType = RTP_UDP;
2017-04-01 16:35:56 +08:00
}
2018-10-30 10:31:27 +08:00
RtspSplitter::enableRecvRtp(_eType == RTP_TCP);
2018-10-24 15:43:52 +08:00
if(_eType == RTP_TCP) {
2017-04-01 16:35:56 +08:00
string interleaved = FindField( FindField((strTransport + ";").c_str(), "interleaved=", ";").c_str(), NULL, "-");
2018-10-26 10:59:13 +08:00
_aTrackInfo[uiTrackIndex]->_interleaved = atoi(interleaved.c_str());
2017-04-01 16:35:56 +08:00
}else{
2018-10-24 15:43:52 +08:00
const char *strPos = (_eType == RTP_MULTICAST ? "port=" : "server_port=") ;
2017-04-01 16:35:56 +08:00
auto port_str = FindField((strTransport + ";").c_str(), strPos, ";");
uint16_t port = atoi(FindField(port_str.c_str(), NULL, "-").c_str());
2018-10-24 15:43:52 +08:00
auto &pUdpSockRef = _apUdpSock[uiTrackIndex];
2017-04-01 16:35:56 +08:00
if(!pUdpSockRef){
pUdpSockRef.reset(new Socket());
}
2018-10-24 15:43:52 +08:00
if (_eType == RTP_MULTICAST) {
2017-04-01 16:35:56 +08:00
auto multiAddr = FindField((strTransport + ";").c_str(), "destination=", ";");
if (!pUdpSockRef->bindUdpSock(port, "0.0.0.0")) {
pUdpSockRef.reset();
throw std::runtime_error("open udp sock err");
}
auto fd = pUdpSockRef->rawFD();
if (-1 == SockUtil::joinMultiAddrFilter(fd, multiAddr.data(), get_peer_ip().data(),get_local_ip().data())) {
SockUtil::joinMultiAddr(fd, multiAddr.data(),get_local_ip().data());
}
} else {
struct sockaddr_in rtpto;
rtpto.sin_port = ntohs(port);
rtpto.sin_family = AF_INET;
rtpto.sin_addr.s_addr = inet_addr(get_peer_ip().c_str());
2018-01-30 09:35:54 +08:00
pUdpSockRef->send("\xce\xfa\xed\xfe", 4,SOCKET_DEFAULE_FLAGS, (struct sockaddr *) &rtpto);
2017-04-01 16:35:56 +08:00
}
}
2018-10-26 09:56:29 +08:00
if (uiTrackIndex < _aTrackInfo.size() - 1) {
2017-04-01 16:35:56 +08:00
//需要继续发送SETUP命令
sendSetup(uiTrackIndex + 1);
return;
}
2018-10-26 09:56:29 +08:00
for (unsigned int i = 0; i < _aTrackInfo.size() && _eType != RTP_TCP; i++) {
2018-10-24 15:43:52 +08:00
auto &pUdpSockRef = _apUdpSock[i];
2017-04-01 16:35:56 +08:00
if(!pUdpSockRef){
continue;
}
auto srcIP = inet_addr(get_peer_ip().data());
weak_ptr<RtspPlayer> weakSelf = dynamic_pointer_cast<RtspPlayer>(shared_from_this());
2018-02-23 15:36:51 +08:00
pUdpSockRef->setOnRead([srcIP,i,weakSelf](const Buffer::Ptr &buf, struct sockaddr *addr) {
2017-04-01 16:35:56 +08:00
auto strongSelf=weakSelf.lock();
if(!strongSelf) {
return;
}
if(((struct sockaddr_in *)addr)->sin_addr.s_addr != srcIP) {
2017-08-09 18:39:30 +08:00
WarnL << "收到请他地址的UDP数据:" << inet_ntoa(((struct sockaddr_in *) addr)->sin_addr);
2017-04-01 16:35:56 +08:00
return;
}
strongSelf->handleOneRtp(i,(unsigned char *)buf->data(),buf->size());
2017-04-01 16:35:56 +08:00
});
}
/////////////////////////心跳/////////////////////////////////
weak_ptr<RtspPlayer> weakSelf = dynamic_pointer_cast<RtspPlayer>(shared_from_this());
2018-10-24 15:43:52 +08:00
_pBeatTimer.reset(new Timer(5, [weakSelf](){
2017-04-01 16:35:56 +08:00
auto strongSelf = weakSelf.lock();
if (!strongSelf){
return false;
}
return strongSelf->sendOptions();
2018-09-14 18:04:41 +08:00
},getExecutor()));
2017-04-01 16:35:56 +08:00
pause(false);
}
bool RtspPlayer::sendOptions() {
2018-10-24 15:43:52 +08:00
_onHandshake = [](const Parser& parser){
2018-10-30 10:31:27 +08:00
// DebugL << "options response";
2017-04-01 16:35:56 +08:00
return true;
};
2018-10-24 15:43:52 +08:00
return sendRtspRequest("OPTIONS",_strContentBase);
2017-04-01 16:35:56 +08:00
}
bool RtspPlayer::sendDescribe() {
//发送DESCRIBE命令后处理函数:handleResDESCRIBE
2018-10-24 15:43:52 +08:00
_onHandshake = std::bind(&RtspPlayer::handleResDESCRIBE,this, placeholders::_1);
StrCaseMap header;
header["Accept"] = "application/sdp";
2018-10-24 15:43:52 +08:00
return sendRtspRequest("DESCRIBE",_strUrl,header);
}
2018-10-26 14:12:16 +08:00
bool RtspPlayer::sendPause(bool bPause,uint32_t seekMS){
2017-04-01 16:35:56 +08:00
if(!bPause){
//修改时间轴
2018-10-24 15:43:52 +08:00
_aNowStampTicker[0].resetTime();
_aNowStampTicker[1].resetTime();
2018-10-26 14:48:09 +08:00
int iTimeInc = seekMS - getProgressMilliSecond();
2018-10-26 09:56:29 +08:00
for(unsigned int i = 0 ;i < _aTrackInfo.size() ;i++){
2018-10-26 14:12:16 +08:00
_aiFistStamp[i] = _aiNowStamp[i] + iTimeInc;
_aiNowStamp[i] = _aiFistStamp[i];
2017-04-01 16:35:56 +08:00
}
2018-10-26 14:12:16 +08:00
_iSeekTo = seekMS;
2017-04-01 16:35:56 +08:00
}
//开启或暂停rtsp
2018-10-24 15:43:52 +08:00
_onHandshake = std::bind(&RtspPlayer::handleResPAUSE,this, placeholders::_1,bPause);
StrCaseMap header;
char buf[8];
2018-10-26 14:12:16 +08:00
sprintf(buf,"%.2f",seekMS / 1000.0);
header["Range"] = StrPrinter << "npt=" << buf << "-";
2018-10-24 15:43:52 +08:00
return sendRtspRequest(bPause ? "PAUSE" : "PLAY",_strContentBase,header);
2017-04-01 16:35:56 +08:00
}
void RtspPlayer::pause(bool bPause) {
2018-10-26 14:12:16 +08:00
sendPause(bPause, getProgressMilliSecond());
2017-04-01 16:35:56 +08:00
}
void RtspPlayer::handleResPAUSE(const Parser& parser, bool bPause) {
2017-04-01 16:35:56 +08:00
if (parser.Url() != "200") {
WarnL <<(bPause ? "Pause" : "Play") << " failed:" << parser.Url() << " " << parser.Tail() << endl;
return;
}
if (!bPause) {
//修正时间轴
2018-10-24 15:43:52 +08:00
_aNowStampTicker[0].resetTime();
_aNowStampTicker[1].resetTime();
2017-04-01 16:35:56 +08:00
auto strRange = parser["Range"];
if (strRange.size()) {
auto strStart = FindField(strRange.data(), "npt=", "-");
if (strStart == "now") {
strStart = "0";
}
2018-10-26 14:12:16 +08:00
_iSeekTo = 1000 * atof(strStart.data());
DebugL << "seekTo(ms):" << _iSeekTo ;
2017-04-01 16:35:56 +08:00
}
auto strRtpInfo = parser["RTP-Info"];
if (strRtpInfo.size()) {
strRtpInfo.append(",");
vector<string> vec = split(strRtpInfo, ",");
2017-04-01 16:35:56 +08:00
for(auto &strTrack : vec){
strTrack.append(";");
2018-05-18 18:48:17 +08:00
auto strControlSuffix = strTrack.substr(1 + strTrack.rfind('/'),strTrack.find(';') - strTrack.rfind('/') - 1);
auto strRtpTime = FindField(strTrack.data(), "rtptime=", ";");
2018-10-26 14:12:16 +08:00
auto idx = getTrackIndexByControlSuffix(strControlSuffix);
_aiFistStamp[idx] = atoll(strRtpTime.data()) * 1000 / _aTrackInfo[idx]->_samplerate;
_aiNowStamp[idx] = _aiFistStamp[idx];
DebugL << "rtptime(ms):" << strControlSuffix <<" " << strRtpTime;
2017-04-01 16:35:56 +08:00
}
}
onPlayResult_l(SockException(Err_success, "rtsp play success"));
2017-04-01 16:35:56 +08:00
} else {
2018-10-24 15:43:52 +08:00
_pRtpTimer.reset();
2017-04-01 16:35:56 +08:00
}
}
2018-10-30 10:31:27 +08:00
void RtspPlayer::onWholeRtspPacket(Parser &parser) {
try {
decltype(_onHandshake) fun;
_onHandshake.swap(fun);
if(fun){
fun(parser);
}
parser.Clear();
} catch (std::exception &err) {
SockException ex(Err_other, err.what());
onPlayResult_l(ex);
onShutdown_l(ex);
teardown();
2017-04-01 16:35:56 +08:00
}
}
2018-10-30 10:31:27 +08:00
void RtspPlayer::onRtpPacket(const char *data, uint64_t len) {
if(len > 1600){
//没有大于MTU的包
return;
}
int trackIdx = -1;
uint8_t interleaved = data[1];
if(interleaved %2 ==0){
trackIdx = getTrackIndexByInterleaved(interleaved);
}
if (trackIdx != -1) {
handleOneRtp(trackIdx, (unsigned char *)data + 4, len - 4);
}
2017-04-01 16:35:56 +08:00
}
# define AV_RB16(x) \
((((const uint8_t*)(x))[0] << 8) | \
((const uint8_t*)(x))[1])
bool RtspPlayer::handleOneRtp(int iTrackidx, unsigned char *pucData, unsigned int uiLen) {
2018-10-24 15:43:52 +08:00
auto &track = _aTrackInfo[iTrackidx];
auto pt_ptr=_pktPool.obtain();
2017-04-01 16:35:56 +08:00
auto &rtppt=*pt_ptr;
2018-10-26 10:59:13 +08:00
rtppt.interleaved = track->_interleaved;
2017-04-01 16:35:56 +08:00
rtppt.length = uiLen + 4;
rtppt.mark = pucData[1] >> 7;
rtppt.PT = pucData[1] & 0x7F;
//序列号
memcpy(&rtppt.sequence,pucData+2,2);//内存对齐
rtppt.sequence = ntohs(rtppt.sequence);
//时间戳
memcpy(&rtppt.timeStamp, pucData+4, 4);//内存对齐
2018-10-26 14:12:16 +08:00
//时间戳转换成毫秒
rtppt.timeStamp = ntohl(rtppt.timeStamp) * 1000 / track->_samplerate;
2017-04-01 16:35:56 +08:00
//ssrc
memcpy(&rtppt.ssrc,pucData+8,4);//内存对齐
rtppt.ssrc = ntohl(rtppt.ssrc);
2018-10-26 10:59:13 +08:00
rtppt.type = track->_type;
if (track->_ssrc == 0) {
track->_ssrc = rtppt.ssrc;
2017-04-01 16:35:56 +08:00
//保存SSRC
2018-10-26 10:59:13 +08:00
} else if (track->_ssrc != rtppt.ssrc) {
2017-04-01 16:35:56 +08:00
//ssrc错误
WarnL << "ssrc错误";
2018-10-24 15:43:52 +08:00
if (_aui32SsrcErrorCnt[iTrackidx]++ > 10) {
2018-10-26 10:59:13 +08:00
track->_ssrc = rtppt.ssrc;
2017-08-09 18:39:30 +08:00
WarnL << "ssrc更换!";
2017-04-01 16:35:56 +08:00
}
return false;
}
2018-10-24 15:43:52 +08:00
_aui32SsrcErrorCnt[iTrackidx] = 0;
2017-04-01 16:35:56 +08:00
rtppt.payload[0] = '$';
rtppt.payload[1] = rtppt.interleaved;
rtppt.payload[2] = (uiLen & 0xFF00) >> 8;
rtppt.payload[3] = (uiLen & 0x00FF);
rtppt.offset = 16;
int csrc = pucData[0] & 0x0f;
int ext = pucData[0] & 0x10;
rtppt.offset += 4 * csrc;
if (ext) {
if(uiLen < rtppt.offset){
return false;
}
/* calculate the header extension length (stored as number of 32-bit words) */
ext = (AV_RB16(pucData + rtppt.offset - 2) + 1) << 2;
rtppt.offset += ext;
}
2017-04-01 16:35:56 +08:00
memcpy(rtppt.payload + 4, pucData, uiLen);
/////////////////////////////////RTP排序逻辑///////////////////////////////////
2018-10-24 15:43:52 +08:00
if(rtppt.sequence != (uint16_t)(_aui16LastSeq[iTrackidx] + 1) && _aui16LastSeq[iTrackidx] != 0){
2017-04-01 16:35:56 +08:00
//包乱序或丢包
2018-10-24 15:43:52 +08:00
_aui64SeqOkCnt[iTrackidx] = 0;
_abSortStarted[iTrackidx] = true;
//WarnL << "包乱序或丢包:" << trackidx <<" " << rtppt.sequence << " " << _aui16LastSeq[trackidx];
2017-04-01 16:35:56 +08:00
}else{
//正确序列的包
2018-10-24 15:43:52 +08:00
_aui64SeqOkCnt[iTrackidx]++;
2017-04-01 16:35:56 +08:00
}
2018-10-24 15:43:52 +08:00
_aui16LastSeq[iTrackidx] = rtppt.sequence;
2017-04-01 16:35:56 +08:00
//开始排序缓存
2018-10-24 15:43:52 +08:00
if (_abSortStarted[iTrackidx]) {
_amapRtpSort[iTrackidx].emplace(rtppt.sequence, pt_ptr);
2018-10-24 17:17:55 +08:00
GET_CONFIG_AND_REGISTER(uint32_t,clearCount,Rtp::kClearCount);
GET_CONFIG_AND_REGISTER(uint32_t,maxRtpCount,Rtp::kMaxRtpCount);
2018-10-24 15:43:52 +08:00
if (_aui64SeqOkCnt[iTrackidx] >= clearCount) {
2017-04-01 16:35:56 +08:00
//网络环境改善,需要清空排序缓存
2018-10-24 15:43:52 +08:00
_aui64SeqOkCnt[iTrackidx] = 0;
_abSortStarted[iTrackidx] = false;
while (_amapRtpSort[iTrackidx].size()) {
2017-04-01 16:35:56 +08:00
POP_HEAD(iTrackidx)
}
2018-10-24 15:43:52 +08:00
} else if (_amapRtpSort[iTrackidx].size() >= maxRtpCount) {
2017-04-01 16:35:56 +08:00
//排序缓存溢出
POP_HEAD(iTrackidx)
}
}else{
//正确序列
onRecvRTP_l(pt_ptr, iTrackidx);
2017-04-01 16:35:56 +08:00
}
//////////////////////////////////////////////////////////////////////////////////
return true;
}
void RtspPlayer::onRecvRTP_l(const RtpPacket::Ptr &rtppt, int trackidx){
2017-04-01 16:35:56 +08:00
//统计丢包率
2018-10-24 15:43:52 +08:00
if (_aui16FirstSeq[trackidx] == 0 || rtppt->sequence < _aui16FirstSeq[trackidx]) {
_aui16FirstSeq[trackidx] = rtppt->sequence;
_aui64RtpRecv[trackidx] = 0;
2017-04-01 16:35:56 +08:00
}
2018-10-24 15:43:52 +08:00
_aui64RtpRecv[trackidx] ++;
_aui16NowSeq[trackidx] = rtppt->sequence;
2017-04-01 16:35:56 +08:00
2018-10-24 15:43:52 +08:00
if (_aNowStampTicker[trackidx].elapsedTime() > 500) {
2018-10-26 14:12:16 +08:00
_aiNowStamp[trackidx] = rtppt->timeStamp;
2017-04-01 16:35:56 +08:00
}
2018-10-24 15:43:52 +08:00
onRecvRTP_l(rtppt,_aTrackInfo[trackidx]);
2017-04-01 16:35:56 +08:00
}
2018-10-26 14:12:16 +08:00
float RtspPlayer::getPacketLossRate(TrackType type) const{
2018-10-26 11:03:53 +08:00
int iTrackIdx = getTrackIndexByTrackType(type);
2017-04-01 16:35:56 +08:00
if(iTrackIdx == -1){
uint64_t totalRecv = 0;
uint64_t totalSend = 0;
2018-10-26 09:56:29 +08:00
for (unsigned int i = 0; i < _aTrackInfo.size(); i++) {
2018-10-24 15:43:52 +08:00
totalRecv += _aui64RtpRecv[i];
totalSend += (_aui16NowSeq[i] - _aui16FirstSeq[i] + 1);
2017-04-01 16:35:56 +08:00
}
if(totalSend == 0){
return 0;
}
return 1.0 - (double)totalRecv / totalSend;
}
2018-10-24 15:43:52 +08:00
if(_aui16NowSeq[iTrackIdx] - _aui16FirstSeq[iTrackIdx] + 1 == 0){
2017-04-01 16:35:56 +08:00
return 0;
}
2018-10-24 15:43:52 +08:00
return 1.0 - (double)_aui64RtpRecv[iTrackIdx] / (_aui16NowSeq[iTrackIdx] - _aui16FirstSeq[iTrackIdx] + 1);
2017-04-01 16:35:56 +08:00
}
2018-10-26 14:12:16 +08:00
uint32_t RtspPlayer::getProgressMilliSecond() const{
uint32_t iTime[2] = {0,0};
2018-10-26 09:56:29 +08:00
for(unsigned int i = 0 ;i < _aTrackInfo.size() ;i++){
2018-10-26 14:12:16 +08:00
iTime[i] = _aiNowStamp[i] - _aiFistStamp[i];
2017-04-01 16:35:56 +08:00
}
2018-10-26 14:12:16 +08:00
return _iSeekTo + MAX(iTime[0],iTime[1]);
2017-04-01 16:35:56 +08:00
}
2018-10-26 14:12:16 +08:00
void RtspPlayer::seekToMilliSecond(uint32_t ms) {
sendPause(false,ms);
2017-04-01 16:35:56 +08:00
}
bool RtspPlayer::sendRtspRequest(const string &cmd, const string &url,const StrCaseMap &header_const) {
auto header = header_const;
2018-10-24 15:43:52 +08:00
header.emplace("CSeq",StrPrinter << _uiCseq++);
if(!_strSession.empty()){
header.emplace("Session",_strSession);
}
if(!(*this)[kRtspRealm].empty() && !(*this)[PlayerBase::kRtspUser].empty()){
2018-07-02 16:00:55 +08:00
if(!(*this)[kRtspMd5Nonce].empty()){
//MD5认证
/*
response计算方法如下
RTSP客户端应该使用username + password并计算response如下:
(1)password为MD5编码,
response = md5( password:nonce:md5(public_method:url) );
(2)password为ANSI字符串,
response= md5( md5(username:realm:password):nonce:md5(public_method:url) );
*/
string encrypted_pwd = (*this)[PlayerBase::kRtspPwd];
if(!(*this)[PlayerBase::kRtspPwdIsMD5].as<bool>()){
encrypted_pwd = MD5((*this)[PlayerBase::kRtspUser]+ ":" + (*this)[kRtspRealm] + ":" + encrypted_pwd).hexdigest();
}
2018-07-02 16:00:55 +08:00
auto response = MD5( encrypted_pwd + ":" + (*this)[kRtspMd5Nonce] + ":" + MD5(cmd + ":" + url).hexdigest()).hexdigest();
_StrPrinter printer;
printer << "Digest ";
printer << "username=\"" << (*this)[PlayerBase::kRtspUser] << "\", ";
printer << "realm=\"" << (*this)[kRtspRealm] << "\", ";
2018-07-02 16:00:55 +08:00
printer << "nonce=\"" << (*this)[kRtspMd5Nonce] << "\", ";
printer << "uri=\"" << url << "\", ";
printer << "response=\"" << response << "\"";
header.emplace("Authorization",printer);
}else if(!(*this)[PlayerBase::kRtspPwdIsMD5].as<bool>()){
//base64认证
string authStr = StrPrinter << (*this)[PlayerBase::kRtspUser] << ":" << (*this)[PlayerBase::kRtspPwd];
char authStrBase64[1024] = {0};
av_base64_encode(authStrBase64,sizeof(authStrBase64),(uint8_t *)authStr.data(),authStr.size());
header.emplace("Authorization",StrPrinter << "Basic " << authStrBase64 );
}
}
_StrPrinter printer;
printer << cmd << " " << url << " RTSP/1.0\r\n";
for (auto &pr : header){
printer << pr.first << ": " << pr.second << "\r\n";
}
return send(printer << "\r\n") > 0;
}
void RtspPlayer::onShutdown_l(const SockException &ex) {
WarnL << ex.getErrCode() << " " << ex.what();
2018-10-24 15:43:52 +08:00
_pPlayTimer.reset();
_pRtpTimer.reset();
_pBeatTimer.reset();
onShutdown(ex);
}
2018-10-26 09:56:29 +08:00
void RtspPlayer::onRecvRTP_l(const RtpPacket::Ptr &pRtppt, const SdpTrack::Ptr &track) {
2018-10-24 15:43:52 +08:00
_rtpTicker.resetTime();
onRecvRTP(pRtppt,track);
}
void RtspPlayer::onPlayResult_l(const SockException &ex) {
WarnL << ex.getErrCode() << " " << ex.what();
2018-10-24 15:43:52 +08:00
_pPlayTimer.reset();
_pRtpTimer.reset();
if (!ex) {
2018-10-24 15:43:52 +08:00
_rtpTicker.resetTime();
weak_ptr<RtspPlayer> weakSelf = dynamic_pointer_cast<RtspPlayer>(shared_from_this());
2018-10-24 15:43:52 +08:00
_pRtpTimer.reset( new Timer(5, [weakSelf]() {
auto strongSelf=weakSelf.lock();
if(!strongSelf) {
return false;
}
2018-10-24 15:43:52 +08:00
if(strongSelf->_rtpTicker.elapsedTime()>10000) {
//recv rtp timeout!
strongSelf->onShutdown_l(SockException(Err_timeout,"recv rtp timeout"));
strongSelf->teardown();
return false;
}
return true;
2018-09-14 18:04:41 +08:00
},getExecutor()));
}
onPlayResult(ex);
}
2018-07-05 18:48:08 +08:00
int RtspPlayer::getTrackIndexByControlSuffix(const string &controlSuffix) const{
2018-10-26 09:56:29 +08:00
for (unsigned int i = 0; i < _aTrackInfo.size(); i++) {
if (_aTrackInfo[i]->_control_surffix == controlSuffix) {
return i;
}
}
return -1;
}
2018-07-05 18:48:08 +08:00
int RtspPlayer::getTrackIndexByInterleaved(int interleaved) const{
2018-10-26 09:56:29 +08:00
for (unsigned int i = 0; i < _aTrackInfo.size(); i++) {
2018-10-26 10:59:13 +08:00
if (_aTrackInfo[i]->_interleaved == interleaved) {
2018-07-05 18:48:08 +08:00
return i;
}
}
return -1;
}
int RtspPlayer::getTrackIndexByTrackType(TrackType trackType) const {
2018-10-26 09:56:29 +08:00
for (unsigned int i = 0; i < _aTrackInfo.size(); i++) {
2018-10-26 10:59:13 +08:00
if (_aTrackInfo[i]->_type == trackType) {
return i;
}
}
return -1;
}
2018-10-24 17:17:55 +08:00
} /* namespace mediakit */
2017-04-01 16:35:56 +08:00