diff --git a/CMakeLists.txt b/CMakeLists.txt index 27ea99c..8756047 100644 --- a/CMakeLists.txt +++ b/CMakeLists.txt @@ -1,6 +1,7 @@ cmake_minimum_required(VERSION 3.9) project( SecMedia + LANGUAGES C CXX VERSION 0.0.1 DESCRIPTION "Security Media Package") set(CMAKE_CXX_STANDARD 11) @@ -83,13 +84,20 @@ file( ${SecMedia_Root}/*/*.c ${SecMedia_Root}/*/*/*.cpp ${SecMedia_Root}/*/*/*.h - ${SecMedia_Root}/*/*/*.c) + ${SecMedia_Root}/*/*/*.c +) file(GLOB SecMedia_api_list ${CMAKE_CURRENT_SOURCE_DIR}/include/common.h) # # target_compile_options(${PROJECT_NAME} PRIVATE -fvisibility=hidden) # list(APPEND LINK_LIB_LIST ${LINK_LIB_SVAC_LIST}) -add_library(${PROJECT_NAME} SHARED ${SecMedia_src_list}) +add_library(${PROJECT_NAME} SHARED +"src/base/util.cpp" +"src/base/rtp_packet.cpp" +"src/SVAC/src/sm2sm3/sm3.c" +"src/SVAC/src/sm2sm3/sm2.c" +${SecMedia_src_list} +) # add_library(${PROJECT_NAME} STATIC ${SecMedia_src_list}) target_link_libraries(${PROJECT_NAME} ${LINK_LIB_SVAC_LIST} rtp) target_include_directories(${PROJECT_NAME} PRIVATE ${SecMedia_Root}/.) diff --git a/PcapSender/main.cpp b/PcapSender/main.cpp index 2849c54..1358b0a 100644 --- a/PcapSender/main.cpp +++ b/PcapSender/main.cpp @@ -1,44 +1,46 @@ -#include +#include "HuaWei/HWsec.h" +#include "HuaWei/HWsign.h" #include #include #include +#include +#include +#include +#include #include -#include -#include -#include #include -#include "HuaWei/HWsign.h" -#include "HuaWei/HWsec.h" +#include using namespace std; using namespace pcpp; -sec_set_info sign_info={ - 2, - "34020000001320000003", - "2021-07-06T17:27:19.000", - 32, - 64, - { - 0x24,0x88,0xc8,0xdc,0x7f,0xd7,0xe0,0x91,0x30,0x1b,0x5c,0x58,0x2f,0xe7,0x44,0x7d, - 0x2f,0x43,0xe4,0xee,0xc8,0x7d,0xc0,0xfb,0xa4,0xb8,0x7d,0x4b,0x8a,0x69,0x7c,0x4e - }, - { - 0xaa,0xb1,0x3f,0xd7,0x66,0xe2,0x75,0x97,0xc0,0x03,0xe6,0xe4,0x1d,0x77,0x54,0x78, - 0xc8,0x29,0xb2,0x0b,0x9e,0xd1,0xff,0xa3,0x6a,0x6f,0xd2,0x7f,0xd6,0x2d,0xaa,0x3f, - 0xc9,0x24,0xec,0x6c,0x96,0x0a,0x7b,0x73,0xf6,0xe6,0xfc,0xda,0x3a,0x08,0xfd,0x92, - 0xfc,0x00,0x08,0x97,0x78,0x2c,0x71,0x6b,0xe1,0x26,0xf5,0x1e,0xba,0x31,0xf5,0xb2, - } - }; -void * EncrypInit(){ +sec_set_info sign_info = { + 2, + "34020000001320000003", + "2021-07-06T17:27:19.000", + 32, + 64, + {0x24, 0x88, 0xc8, 0xdc, 0x7f, 0xd7, 0xe0, 0x91, 0x30, 0x1b, 0x5c, 0x58, 0x2f, 0xe7, 0x44, 0x7d, + 0x2f, 0x43, 0xe4, 0xee, 0xc8, 0x7d, 0xc0, 0xfb, 0xa4, 0xb8, 0x7d, 0x4b, 0x8a, 0x69, 0x7c, 0x4e}, + { + 0xaa, 0xb1, 0x3f, 0xd7, 0x66, 0xe2, 0x75, 0x97, 0xc0, 0x03, 0xe6, 0xe4, 0x1d, 0x77, 0x54, 0x78, + 0xc8, 0x29, 0xb2, 0x0b, 0x9e, 0xd1, 0xff, 0xa3, 0x6a, 0x6f, 0xd2, 0x7f, 0xd6, 0x2d, 0xaa, 0x3f, + 0xc9, 0x24, 0xec, 0x6c, 0x96, 0x0a, 0x7b, 0x73, 0xf6, 0xe6, 0xfc, 0xda, 0x3a, 0x08, 0xfd, 0x92, + 0xfc, 0x00, 0x08, 0x97, 0x78, 0x2c, 0x71, 0x6b, 0xe1, 0x26, 0xf5, 0x1e, 0xba, 0x31, 0xf5, 0xb2, + }}; + +void * +EncrypInit() +{ // auto Verify_handle=HWVerify_init(); - auto sign_handle=GB28181_stream_init(&sign_info); //HWSign_init(&sign_info); + auto sign_handle = GB28181_stream_init(&sign_info);//HWSign_init(&sign_info); return sign_handle; } -std::string getProtocolTypeAsString(pcpp::ProtocolType protocolType) + +std::string +getProtocolTypeAsString(pcpp::ProtocolType protocolType) { - switch (protocolType) - { + switch (protocolType) { case pcpp::Ethernet: return "Ethernet"; case pcpp::IPv4: @@ -53,116 +55,132 @@ std::string getProtocolTypeAsString(pcpp::ProtocolType protocolType) default: return "Unknown"; } - } -inline void sleep(timeval & delta){ +inline void +sleep(timeval &delta) +{ // delta.tv_sec - select(0,NULL,NULL,NULL,&delta); + select(0, NULL, NULL, NULL, &delta); } -template -timespec TimeDiff(T && minu,U && sub){ + +template +timespec +TimeDiff(T &&minu, U &&sub) +{ timespec deltatime; - deltatime.tv_nsec=minu.tv_nsec-sub.tv_nsec; - deltatime.tv_sec=minu.tv_sec-sub.tv_sec; - if(deltatime.tv_nsec<0 && deltatime.tv_sec>0){ - deltatime.tv_nsec+=1000000000; + deltatime.tv_nsec = minu.tv_nsec - sub.tv_nsec; + deltatime.tv_sec = minu.tv_sec - sub.tv_sec; + if (deltatime.tv_nsec < 0 && deltatime.tv_sec > 0) { + deltatime.tv_nsec += 1000000000; deltatime.tv_sec--; } return move(deltatime); } -int ReadPcapAndSend(int socket,sockaddr_in & addr,const string & filename,const string & filter,void * sign_handle){ +int +ReadPcapAndSend(int socket, sockaddr_in &addr, const string &filename, const string &filter, void *sign_handle) +{ // auto sign_h2=EncrypInit(); - auto reader=pcpp::IFileReaderDevice::getReader(filename); + auto reader = pcpp::IFileReaderDevice::getReader(filename); // verify that a reader interface was indeed created - if (reader == NULL) - { + if (reader == NULL) { std::cerr << "Cannot determine reader for file type" << std::endl; return 1; } // open the reader for reading - if (!reader->open()) - { + if (!reader->open()) { std::cerr << "Cannot open input.pcap for reading" << std::endl; return 1; } - if (!reader->setFilter(filter)) - { + if (!reader->setFilter(filter)) { std::cerr << "Cannot set filter for file reader" << std::endl; return 1; } - uint8_t * payload; + uint8_t *payload; size_t payload_len; pcpp::RawPacket rawPacket; - bool first_flag=true; - timespec nowtime,gaptime; + bool first_flag = true; + timespec nowtime, gaptime; timespec real_now; - timespec inital_time,current_time; - static char sign_out_buf[3096]; + timespec inital_time, current_time; + static char sign_out_buf[3096]; unsigned int sign_out_len; - void *param=nullptr; - uint16_t offset_len,append_len; - while (reader->getNextPacket(rawPacket)) - { - pcpp::Packet parsedPacket(&rawPacket,OsiModelTransportLayer); - auto layer = parsedPacket.getLayerOfType(false); - - if(layer){ - payload=layer->getLayerPayload(); - payload_len=layer->getLayerPayloadSize(); - // cout<<" payload_len:" << payload_len<=0 && gaptime.tv_sec>=0) - { - nanosleep(&gaptime,NULL); - }else{ - // cout<<" s:" << gaptime.tv_sec<<" ns:" << gaptime.tv_nsec < output_thread; + std::atomic processing{true}; + std::atomic processing_cnt{0}; + if (sign_handle) { + output_thread = std::shared_ptr(new std::thread([&] { + while (processing.load(std::memory_order_relaxed)) { + int ret = + GB28181_stream_out(sign_handle, sign_out_buf, &sign_out_len, &offset_len, &append_len, ¶m); + if (ret != 1) { continue; } + processing_cnt.fetch_sub(1); + if (append_len == 0) { + sendto(socket, sign_out_buf, sign_out_len, 0, (const sockaddr *) &addr, sizeof(addr)); + } else { + sendto(socket, sign_out_buf, offset_len, 0, (const sockaddr *) &addr, sizeof(addr)); + sendto(socket, sign_out_buf + offset_len, sign_out_len - offset_len, 0, (const sockaddr *) &addr, + sizeof(addr)); } // GB28181_stream_in(sign_h2,(char*)payload,payload_len,nullptr); // GB28181_stream_out(sign_h2,sign_out_buf,&sign_out_len,&offset_len,&append_len, ¶m); - - - - }else{ - if(sendto(socket,payload,payload_len,0,(const sockaddr*)&addr,sizeof(addr))==-1){ + } + })); + } + + while (reader->getNextPacket(rawPacket)) { + pcpp::Packet parsedPacket(&rawPacket, OsiModelTransportLayer); + auto layer = parsedPacket.getLayerOfType(false); + + if (layer) { + payload = layer->getLayerPayload(); + payload_len = layer->getLayerPayloadSize(); + // cout<<" payload_len:" << payload_len<= 0 && gaptime.tv_sec >= 0) { + nanosleep(&gaptime, NULL); + } else { + // cout<<" s:" << gaptime.tv_sec<<" ns:" << gaptime.tv_nsec < 0) { + timeval delta = {0, 100000}; + sleep(delta); + } + processing.store(false); + output_thread->join(); + } // reader->getNextPacket(rawPacket); - + // for (pcpp::Layer* curLayer = parsedPacket.getFirstLayer(); curLayer != NULL; curLayer = curLayer->getNextLayer()) // { // std::cout @@ -175,44 +193,43 @@ int ReadPcapAndSend(int socket,sockaddr_in & addr,const string & filename,const // create the stats object pcpp::IPcapDevice::PcapStats stats; reader->getStatistics(stats); - std::cout << "Read " << stats.packetsRecv << " packets successfully and " << stats.packetsDrop << " packets could not be read" << std::flush; + std::cout << "Read " << stats.packetsRecv << " packets successfully and " << stats.packetsDrop + << " packets could not be read" << std::flush; return 0; } -int main(int argc, char *argv[]){ - - char ip[16] = {0}; - int sockfd, port; - if (argc>4) - { - string filename(argv[1]); - strcpy(ip, argv[2]); - port = atoi(argv[3]); - string filter(argv[4]); - printf("filename:%s\nip:%s\nport:%d\nfilter:%s\n", filename.data(), ip,port,filter.data()); - sockfd = socket(AF_INET, SOCK_DGRAM , IPPROTO_UDP);//SOCK_STREAM +int +main(int argc, char *argv[]) +{ + + char ip[16] = {0}; + int sockfd, port; + if (argc > 4) { + string filename(argv[1]); + strcpy(ip, argv[2]); + port = atoi(argv[3]); + string filter(argv[4]); + printf("filename:%s\nip:%s\nport:%d\nfilter:%s\n", filename.data(), ip, port, filter.data()); + + sockfd = socket(AF_INET, SOCK_DGRAM, IPPROTO_UDP);//SOCK_STREAM if (sockfd == -1) { printf("create socket failed : %s\n", strerror(errno)); return -1; - } + } int rcvBufSize = 2097152; int rcvlen = sizeof(rcvBufSize); - setsockopt(sockfd, SOL_SOCKET, SO_SNDBUF, (char*)&rcvBufSize, sizeof(rcvBufSize)); - if (getsockopt(sockfd, SOL_SOCKET, SO_SNDBUF, (char*)&rcvBufSize, (socklen_t *)&rcvlen) >= 0) - { + setsockopt(sockfd, SOL_SOCKET, SO_SNDBUF, (char *) &rcvBufSize, sizeof(rcvBufSize)); + if (getsockopt(sockfd, SOL_SOCKET, SO_SNDBUF, (char *) &rcvBufSize, (socklen_t *) &rcvlen) >= 0) { printf("set udp socket send buff size to : %d\n", rcvBufSize); - if (rcvBufSize < 4194304) - { - printf("socket send buff too small, please set up to 2097152(2M)"); - } - }else { - printf("socket failed : %s\n", strerror(errno)); + if (rcvBufSize < 4194304) { printf("socket send buff too small, please set up to 2097152(2M)"); } + } else { + printf("socket failed : %s\n", strerror(errno)); return -1; - } + } struct sockaddr_in addr; addr.sin_family = AF_INET; addr.sin_port = htons(port); - addr.sin_addr.s_addr =inet_addr(ip); + addr.sin_addr.s_addr = inet_addr(ip); // if(connect(sockfd, (struct sockaddr*)&addr, sizeof(addr))==-1){ // printf("connection error : %s\n", strerror(errno)); // return -1; @@ -220,19 +237,16 @@ int main(int argc, char *argv[]){ // bind(sockfd, (struct sockaddr*)&addr, sizeof(addr)); // while (1) // { - cout.flush(); - auto sign_h=EncrypInit(); - - ReadPcapAndSend(sockfd,addr,filename,filter,sign_h); + cout.flush(); + auto sign_h = EncrypInit(); + + ReadPcapAndSend(sockfd, addr, filename, filter, sign_h); // } - - } - else - { - printf("CMD as: filename.pcap ip port\n"); - system("pause"); - return 0; - } + + } else { + printf("CMD as: filename.pcap ip port\n"); + system("pause"); + return 0; + } return 0; - -} \ No newline at end of file +} diff --git a/src/HuaWei/HWsign.cpp b/src/HuaWei/HWsign.cpp index 543146f..6606f5b 100644 --- a/src/HuaWei/HWsign.cpp +++ b/src/HuaWei/HWsign.cpp @@ -1,137 +1,140 @@ +#include "HuaWei/HWsign.h" +#include "HWcommon.h" +#include "common.h" +#include #include #include #include #include -#include -#include -#include "common.h" -#include "HWcommon.h" -#include "HuaWei/HWsign.h" +#include #include "DecEnc/NALUdecode.h" #include "DecEnc/base64.h" #include "HuaWei/HWsec.h" #ifdef ENABLE_HARDWARE_SIGN - #include "sm/sm.h" +#include "sm/sm.h" #endif +void send_rtp(HWsign *Handle, const char *buf, const uint32_t len, int tcp, void *param); -void send_rtp(HWsign* Handle,const char * buf, const uint32_t len ,int tcp,void * param); - -void print_data2(const char * buf, uint32_t len,uint8_t offest){ - printf("\n --%d-- \n",len); - for (int num = 0; num < offest; num++) - { - printf("%02X ", (uint8_t)buf[num]); - } +void +print_data2(const char *buf, uint32_t len, uint8_t offest) +{ + printf("\n --%d-- \n", len); + for (int num = 0; num < offest; num++) { printf("%02X ", (uint8_t) buf[num]); } printf(", "); - for (int num = offest; num < 20; num++) - { - printf("%02X ", (uint8_t)buf[num]); - } + for (int num = offest; num < 20; num++) { printf("%02X ", (uint8_t) buf[num]); } printf("\n ---- \n"); } -void print_rtp2(const char * buf, uint32_t len,uint8_t offest){ - uint8_t mask=0; - uint16_t seq=0; - uint32_t stamp=0; - mask=(uint8_t)*(buf+1)>>7; +void +print_rtp2(const char *buf, uint32_t len, uint8_t offest) +{ + uint8_t mask = 0; + uint16_t seq = 0; + uint32_t stamp = 0; + mask = (uint8_t) * (buf + 1) >> 7; memcpy(&seq, buf + 2, 2); - seq= ntohs(seq); + seq = ntohs(seq); memcpy(&stamp, buf + 4, 4); - stamp= ntohl(stamp); - DEBUGL("seq %d stamp %d mask %d",seq,stamp,mask); - print_data2(buf,len,offest); + stamp = ntohl(stamp); + DEBUGL("seq %d stamp %d mask %d", seq, stamp, mask); + print_data2(buf, len, offest); } #ifdef ENABLE_HARDWARE_SIGN -int hardware_sign_l(SM2Config * config,const unsigned char * data_in,const size_t in_len, unsigned char * sign_out, uint16_t * sign_len){ +int +hardware_sign_l(SM2Config *config, + const unsigned char *data_in, + const size_t in_len, + unsigned char *sign_out, + uint16_t *sign_len) +{ int rv = 0; rv = Device_Init(); - printf("Device_Init rv = 0x%02x\n", rv); - if(rv != 0) - { - printf("Device_Init Fail\n"); - return -1; - } + printf("Device_Init rv = 0x%02x\n", rv); + if (rv != 0) { + printf("Device_Init Fail\n"); + return -1; + } unsigned char Hash_Data[35]; - unsigned int Hash_Data_len = 32; - rv = Generate_Hash(data_in, (const unsigned int)in_len, Hash_Data, &Hash_Data_len, NULL, SGD_SM3); - if(rv != 0) - { - printf("Generate_Hash FAIL\n\n"); - return -1; - } - else printf("Generate_Hash SUCCESS\n\n"); + unsigned int Hash_Data_len = 32; + rv = Generate_Hash(data_in, (const unsigned int) in_len, Hash_Data, &Hash_Data_len, NULL, SGD_SM3); + if (rv != 0) { + printf("Generate_Hash FAIL\n\n"); + return -1; + } else + printf("Generate_Hash SUCCESS\n\n"); - unsigned int Sign_Data_len = 65; - *sign_len=Sign_Data_len; - rv = Generate_SignData_ExtPrikey(config->prikey, Hash_Data, Hash_Data_len, sign_out, &Sign_Data_len); - if(rv != 0) - { - printf("Generate_SignData_ExtPrikey Fail\n"); - return 0; - } - else printf("Generate_SignData_ExtPrikey SUCCESS\n"); + unsigned int Sign_Data_len = 65; + *sign_len = Sign_Data_len; + rv = Generate_SignData_ExtPrikey(config->prikey, Hash_Data, Hash_Data_len, sign_out, &Sign_Data_len); + if (rv != 0) { + printf("Generate_SignData_ExtPrikey Fail\n"); + return 0; + } else + printf("Generate_SignData_ExtPrikey SUCCESS\n"); return 1; } -int Hardware_sign(SM2Config * config,const unsigned char * data_in,const size_t in_len, unsigned char * sign_out, uint16_t * sign_len){ +int +Hardware_sign(SM2Config *config, + const unsigned char *data_in, + const size_t in_len, + unsigned char *sign_out, + uint16_t *sign_len) +{ int ret; - ret=hardware_sign_l(config,data_in,in_len,sign_out,sign_len); + ret = hardware_sign_l(config, data_in, in_len, sign_out, sign_len); Close_Device(); return ret; } #endif - -void ThreadSign(HWsign * HW_ptr){ +void +ThreadSign(HWsign *HW_ptr) +{ uint8_t sha[128]; cpu_set_t mask; CPU_ZERO(&mask); - CPU_SET(HW_ptr->cpu_core,&mask); - if(pthread_setaffinity_np(pthread_self(),sizeof(mask),&mask)<0){ - ERROL("Sign Thread start fail"); - } - while (1) - { + CPU_SET(HW_ptr->cpu_core, &mask); + if (pthread_setaffinity_np(pthread_self(), sizeof(mask), &mask) < 0) { ERROL("Sign Thread start fail"); } + while (1) { std::unique_lock lock(HW_ptr->sign_mtx); - while (HW_ptr->I_seq!=-2) - { - if(HW_ptr->thread_exit){ + while (HW_ptr->I_seq != -2) { + if (HW_ptr->thread_exit) { NOTICEL("sign thread release\n"); sleep(0); return; } HW_ptr->sign_start.wait(lock); } - if(HW_ptr->thread_exit){ - NOTICEL("sign thread release\n"); - sleep(0); - return; + if (HW_ptr->thread_exit) { + NOTICEL("sign thread release\n"); + sleep(0); + return; } SUCSL("Start sign\n"); - NOTICEL("sign cpu:%d\n",sched_getcpu()); - sm3_update(HW_ptr->sm3_hd,(uint8_t*)HW_ptr->buff->data(),HW_ptr->buff->size()); - sm3_final(HW_ptr->sm3_hd,sha); - do_sm2_sign((char*)HW_ptr->sm2_hd->prikey,(char*)HW_ptr->sm2_hd->pubkey,(char *) sha, 32, (char *)HW_ptr->sign); + NOTICEL("sign cpu:%d\n", sched_getcpu()); + sm3_update(HW_ptr->sm3_hd, (uint8_t *) HW_ptr->buff->data(), HW_ptr->buff->size()); + sm3_final(HW_ptr->sm3_hd, sha); + do_sm2_sign((char *) HW_ptr->sm2_hd->prikey, (char *) HW_ptr->sm2_hd->pubkey, (char *) sha, 32, + (char *) HW_ptr->sign); // Hardware_sign(Handle->sm2_hd,(const unsigned char *)(buf+offset),len-offset,sign,&sign_len); - HW_ptr->ver_set.sign_len=64; - memcpy(HW_ptr->ver_set.sign,HW_ptr->sign,64); - HW_ptr->I_seq=-5; - + HW_ptr->ver_set.sign_len = 64; + memcpy(HW_ptr->ver_set.sign, HW_ptr->sign, 64); + HW_ptr->I_seq = -5; + DEBUGL("\n&&&&&&&& sign: hash &&&&&&&&&&&&&&&&&&&&&&&&"); - print_data2((char*)sha,32,32); + print_data2((char *) sha, 32, 32); DEBUGL("\n&&&&&&&& sign: sign &&&&&&&&&&&&&&&&&&&&&&&&"); - print_data2((char*)HW_ptr->sign,64,64); - + print_data2((char *) HW_ptr->sign, 64, 64); // HW_ptr->sign_finish.notify_all(); } @@ -155,130 +158,131 @@ void ThreadSign(HWsign * HW_ptr){ // SUCSL("success sign!!!!!!!!!! sei package\n"); // // send_rtp(HW_ptr,(char *) sei_head,sei_len,0,param); // send_rtp(HW_ptr,(char *) sei,rtp_len,0,param); - + // } -void GenSEI(HWsign * HW_ptr,const char * sei_head, const uint16_t sei_len,void * param){ - uint8_t sei[2048],sei_race[1024]; - uint16_t sign_len=64; - uint8_t * set_ptr=sei; +void +GenSEI(HWsign *HW_ptr, const char *sei_head, const uint16_t sei_len, void *param) +{ + uint8_t sei[2048], sei_race[1024]; + uint16_t sign_len = 64; + uint8_t *set_ptr = sei; uint32_t rtp_len; - memcpy(set_ptr,sei_head,sei_len); - set_ptr+=sei_len; - set_ptr=SecMedia::appendSEIframe(set_ptr,SEC_SET_PT,(uint8_t*)SecMedia::Sec_set_UUID,(uint8_t*)&HW_ptr->sec_set,sizeof(HW_ptr->sec_set)); - set_ptr=SecMedia::appendSEIframe(set_ptr,VER_SET_PT,(uint8_t*)SecMedia::Ver_set_UUID,(uint8_t*)&HW_ptr->ver_set,sizeof(HW_ptr->ver_set)); - HW_ptr->sei_param=nullptr; - rtp_len=set_ptr-sei; + memcpy(set_ptr, sei_head, sei_len); + set_ptr += sei_len; + set_ptr = SecMedia::appendSEIframe( + set_ptr, SEC_SET_PT, (uint8_t *) SecMedia::Sec_set_UUID, (uint8_t *) &HW_ptr->sec_set, sizeof(HW_ptr->sec_set)); + set_ptr = SecMedia::appendSEIframe( + set_ptr, VER_SET_PT, (uint8_t *) SecMedia::Ver_set_UUID, (uint8_t *) &HW_ptr->ver_set, sizeof(HW_ptr->ver_set)); + HW_ptr->sei_param = nullptr; + rtp_len = set_ptr - sei; SUCSL("success sign!!!!!!!!!! sei package\n"); // send_rtp(HW_ptr,(char *) sei_head,sei_len,0,param); - send_rtp(HW_ptr,(char *) sei,rtp_len,0,param); - + send_rtp(HW_ptr, (char *) sei, rtp_len, 0, param); } - -bool MakeFU(uint8_t in, FU &fu) { +bool +MakeFU(uint8_t in, FU &fu) +{ fu.S = in >> 7; fu.E = (in >> 6) & 0x01; fu.R = (in >> 5) & 0x01; fu.type = in & 0x1f; - if (fu.R != 0) { - return false; - } + if (fu.R != 0) { return false; } return true; } -void Make265FU(uint8_t in, FU &fu) { +void +Make265FU(uint8_t in, FU &fu) +{ fu.S = in >> 7; fu.E = (in >> 6) & 0x01; fu.type = in & 0x3f; } - -uint32_t add_racing_code(uint8_t *dst,uint8_t *src, uint32_t src_len,uint16_t jump_bytes) +uint32_t +add_racing_code(uint8_t *dst, uint8_t *src, uint32_t src_len, uint16_t jump_bytes) { - const uint8_t d_zero[]={0x00,0x00}; - uint8_t *ptr_zero=src+jump_bytes,*dst_head=dst,*src_tail=src+src_len, *noncpy_src_head=src; - uint32_t data_len=0,remain_data_len=src_len-jump_bytes; - while(remain_data_len>2) - { - ptr_zero=(uint8_t*) memmem(ptr_zero,remain_data_len-2,&d_zero,sizeof(d_zero)); - if(ptr_zero ){ //0x00 1 2 3 - ptr_zero+=2; - - if(!(*(ptr_zero)&0xFC)){ - data_len=ptr_zero-noncpy_src_head; - memcpy(dst_head,noncpy_src_head,data_len); - dst_head+=data_len; - *(dst_head++)=0x03; - noncpy_src_head=ptr_zero; //更新未复制的源数据头 + const uint8_t d_zero[] = {0x00, 0x00}; + uint8_t *ptr_zero = src + jump_bytes, *dst_head = dst, *src_tail = src + src_len, *noncpy_src_head = src; + uint32_t data_len = 0, remain_data_len = src_len - jump_bytes; + while (remain_data_len > 2) { + ptr_zero = (uint8_t *) memmem(ptr_zero, remain_data_len - 2, &d_zero, sizeof(d_zero)); + if (ptr_zero) {//0x00 1 2 3 + ptr_zero += 2; + + if (!(*(ptr_zero) & 0xFC)) { + data_len = ptr_zero - noncpy_src_head; + memcpy(dst_head, noncpy_src_head, data_len); + dst_head += data_len; + *(dst_head++) = 0x03; + noncpy_src_head = ptr_zero;//更新未复制的源数据头 } - remain_data_len=(src_tail-ptr_zero); - }else - { + remain_data_len = (src_tail - ptr_zero); + } else { break; } } - data_len=src_tail-noncpy_src_head; - memcpy(dst_head,noncpy_src_head,data_len); + data_len = src_tail - noncpy_src_head; + memcpy(dst_head, noncpy_src_head, data_len); //int finnum=(int)(dst_head-dst)+(int)data_len; - return (uint32_t)(dst_head-dst)+data_len;; + return (uint32_t) (dst_head - dst) + data_len; + ; } -uint32_t del_racing_code(uint8_t *dst,uint8_t *src, uint32_t src_len) +uint32_t +del_racing_code(uint8_t *dst, uint8_t *src, uint32_t src_len) { - const uint8_t d_zero[]={0x00,0x00,0x03}; - uint8_t *ptr_zero=src,*dst_head=dst,*src_tail=src+src_len, *noncpy_src_head=src; - uint32_t data_len=0,remain_data_len=src_len; - while(remain_data_len>2) - { - ptr_zero=(uint8_t*) memmem(ptr_zero,remain_data_len-2,&d_zero,sizeof(d_zero)); - if(ptr_zero ){ //0x00 1 2 3 - ptr_zero+=3; - + const uint8_t d_zero[] = {0x00, 0x00, 0x03}; + uint8_t *ptr_zero = src, *dst_head = dst, *src_tail = src + src_len, *noncpy_src_head = src; + uint32_t data_len = 0, remain_data_len = src_len; + while (remain_data_len > 2) { + ptr_zero = (uint8_t *) memmem(ptr_zero, remain_data_len - 2, &d_zero, sizeof(d_zero)); + if (ptr_zero) {//0x00 1 2 3 + ptr_zero += 3; - data_len=ptr_zero-noncpy_src_head-1;//末尾0x03 不要 - memcpy(dst_head,noncpy_src_head,data_len); - dst_head+=data_len; + data_len = ptr_zero - noncpy_src_head - 1;//末尾0x03 不要 + memcpy(dst_head, noncpy_src_head, data_len); + dst_head += data_len; - noncpy_src_head=ptr_zero; //更新未复制的源数据头 + noncpy_src_head = ptr_zero;//更新未复制的源数据头 - remain_data_len=(src_tail-ptr_zero); - }else - { + remain_data_len = (src_tail - ptr_zero); + } else { break; } } - data_len=src_tail-noncpy_src_head; - memcpy(dst_head,noncpy_src_head,data_len); + data_len = src_tail - noncpy_src_head; + memcpy(dst_head, noncpy_src_head, data_len); //int finnum=(int)(dst_head-dst)+(int)data_len; - return (uint32_t)(dst_head-dst)+data_len;; + return (uint32_t) (dst_head - dst) + data_len; + ; } - // void * HWSign_init(const function rtp_callback){ -void * HWSign_init(struct sec_set_info * sign_info){ - if(!sign_info) return nullptr; - HWsign* HWSign_hd= new HWsign(); - HWSign_hd->I_seq=-1; - HWSign_hd->in=0; - HWSign_hd->out=0; - HWSign_hd->seq_accu=0; - HWSign_hd->stamp=0; - HWSign_hd->buff_offest=0; - HWSign_hd->track_type=CodecInvalid; - HWSign_hd->sm3_hd=new sm3_ctx(); - HWSign_hd->sm2_hd=new SM2Config(); - HWSign_hd->buff=new string(); - HWSign_hd->rtp_buff = new list,void *>>(); - HWSign_hd->buff_que =new ThreadsafeQueue,void *>>(); +void * +HWSign_init(struct sec_set_info *sign_info) +{ + if (!sign_info) return nullptr; + HWsign *HWSign_hd = new HWsign(); + HWSign_hd->I_seq = -1; + HWSign_hd->in = 0; + HWSign_hd->out = 0; + HWSign_hd->seq_accu = 0; + HWSign_hd->stamp = 0; + HWSign_hd->buff_offest = 0; + HWSign_hd->track_type = CodecInvalid; + HWSign_hd->sm3_hd = new sm3_ctx(); + HWSign_hd->sm2_hd = new SM2Config(); + HWSign_hd->buff = new string(); + HWSign_hd->rtp_buff = new list, void *>>(); + HWSign_hd->buff_que = new ThreadsafeQueue, void *>>(); // HWSign_hd->rtp_cb=rtp_callback; - HWSign_hd->rtp_cb=[HWSign_hd](const char * rtp_ptr, const uint32_t rtp_len,void * param){ - + HWSign_hd->rtp_cb = [HWSign_hd](const char *rtp_ptr, const uint32_t rtp_len, void *param) { DEBUGL("\n========================= output ====== "); // print_rtp2(rtp_ptr,rtp_len,12); - auto str_ptr=make_shared(rtp_ptr,rtp_len); - HWSign_hd->buff_que->push(make_pair(str_ptr,param)); - + auto str_ptr = make_shared(rtp_ptr, rtp_len); + HWSign_hd->buff_que->push(make_pair(str_ptr, param)); }; sm3_init(HWSign_hd->sm3_hd); // SM2Config sm2fig={ @@ -295,90 +299,106 @@ void * HWSign_init(struct sec_set_info * sign_info){ // 0xfc,0x00,0x08,0x97,0x78,0x2c,0x71,0x6b,0xe1,0x26,0xf5,0x1e,0xba,0x31,0xf5,0xb2, // } // }; - HWSign_hd->sm2_hd->prikey_size=sign_info->prikey_size; - HWSign_hd->sm2_hd->pubkey_size=sign_info->pubkey_size; - memcpy(HWSign_hd->sm2_hd->prikey,sign_info->prikey,sign_info->prikey_size); - memcpy(HWSign_hd->sm2_hd->pubkey,sign_info->pubkey,sign_info->pubkey_size); - genSECset(HWSign_hd,sign_info); - HWSign_hd->cpu_core=sign_info->cpu_core; - HWSign_hd->thread_exit=0; - HWSign_hd->sign_thread=new std::thread(ThreadSign,HWSign_hd); + HWSign_hd->sm2_hd->prikey_size = sign_info->prikey_size; + HWSign_hd->sm2_hd->pubkey_size = sign_info->pubkey_size; + memcpy(HWSign_hd->sm2_hd->prikey, sign_info->prikey, sign_info->prikey_size); + memcpy(HWSign_hd->sm2_hd->pubkey, sign_info->pubkey, sign_info->pubkey_size); + genSECset(HWSign_hd, sign_info); + HWSign_hd->cpu_core = sign_info->cpu_core; + HWSign_hd->thread_exit = 0; + HWSign_hd->sign_thread = new std::thread(ThreadSign, HWSign_hd); HWSign_hd->sign_thread->detach(); - return (void*)HWSign_hd; + return (void *) HWSign_hd; } -void HWSign_release(void* Handle){ - HWsign* HWSign_hd=(HWsign*) Handle; +void +HWSign_release(void *Handle) +{ + HWsign *HWSign_hd = (HWsign *) Handle; delete HWSign_hd->sm3_hd; delete HWSign_hd->sm2_hd; delete HWSign_hd->buff; delete HWSign_hd->rtp_buff; - HWSign_hd->thread_exit=1; + HWSign_hd->thread_exit = 1; HWSign_hd->sign_start.notify_all(); delete HWSign_hd->sign_thread; - HWSign_hd->rtp_cb=nullptr; + HWSign_hd->rtp_cb = nullptr; } -uint16_t get_sequence(const char * rtp ,int tcp){ +uint16_t +get_sequence(const char *rtp, int tcp) +{ uint16_t seq; - if(tcp){ + if (tcp) { memcpy(&seq, rtp + 2 + 4, 2); - }else{ + } else { memcpy(&seq, rtp + 2 + 0, 2); } return htons(seq); } -void send_rtp(HWsign* Handle,const char * buf, const uint32_t len ,int tcp,void * param){ - char * send_buff=(char *)malloc(len); - uint8_t offset,offset2; +void +send_rtp(HWsign *Handle, const char *buf, const uint32_t len, int tcp, void *param) +{ + char *send_buff = (char *) malloc(len); + uint8_t offset, offset2; uint16_t seq; - memcpy(send_buff,buf,len); - if (tcp) - { - offset2=16; - offset=4; - send_buff[2] = (len-4) >> 8; - send_buff[3] = (len-4) & 0x00FF; - }else - { - offset2=12; - offset=0; + memcpy(send_buff, buf, len); + if (tcp) { + offset2 = 16; + offset = 4; + send_buff[2] = (len - 4) >> 8; + send_buff[3] = (len - 4) & 0x00FF; + } else { + offset2 = 12; + offset = 0; } memcpy(&seq, buf + 2 + offset, 2); - seq=ntohs(seq)+Handle->seq_accu; - seq=htons(seq); - memcpy(send_buff+offset+2, &seq, 2); + seq = ntohs(seq) + Handle->seq_accu; + seq = htons(seq); + memcpy(send_buff + offset + 2, &seq, 2); // DEBUGL("\n@@@@@@@@@@@@@@@@@@@@@@@@@@@@@@ modify @@@@@@@@@ id %d ",id); // print_rtp2(send_buff,len,offset2); - Handle->rtp_cb(send_buff,len,param); + Handle->rtp_cb(send_buff, len, param); free(send_buff); } -void sign_data(HWsign* Handle,const char * buf, const uint32_t len,uint8_t offset,int tcp,void * param,const char * sei_head, const uint16_t sei_len){ - uint8_t sha[128],sign[128],sei[2048],sei_race[1024]; - uint16_t sign_len=64; - sm3_update(Handle->sm3_hd,(uint8_t*)buf+offset,len-offset); - sm3_final(Handle->sm3_hd,sha); - do_sm2_sign((char*)Handle->sm2_hd->prikey,(char*)Handle->sm2_hd->pubkey,(char *) sha, 32, (char *)sign); + +void +sign_data(HWsign *Handle, + const char *buf, + const uint32_t len, + uint8_t offset, + int tcp, + void *param, + const char *sei_head, + const uint16_t sei_len) +{ + uint8_t sha[128], sign[128], sei[2048], sei_race[1024]; + uint16_t sign_len = 64; + sm3_update(Handle->sm3_hd, (uint8_t *) buf + offset, len - offset); + sm3_final(Handle->sm3_hd, sha); + do_sm2_sign((char *) Handle->sm2_hd->prikey, (char *) Handle->sm2_hd->pubkey, (char *) sha, 32, (char *) sign); // Hardware_sign(Handle->sm2_hd,(const unsigned char *)(buf+offset),len-offset,sign,&sign_len); DEBUGL("\n&&&&&&&& sign: hash &&&&&&&&&&&&&&&&&&&&&&&&"); - print_data2((char*)sha,32,32); + print_data2((char *) sha, 32, 32); DEBUGL("\n&&&&&&&& sign: sign &&&&&&&&&&&&&&&&&&&&&&&&"); - print_data2((char*)sign,64,64); + print_data2((char *) sign, 64, 64); - Handle->sei_param=nullptr; - auto rtp_len=SecMedia::GeneHWSecritySEI(sei,Handle->track_type,1,len-offset,sign_len,sign,(char *)sei_head,sei_len); - rtp_len=add_racing_code(sei_race,sei+sei_len,rtp_len-sei_len); - memcpy(sei+sei_len,sei_race,rtp_len); - rtp_len+=sei_len; + Handle->sei_param = nullptr; + auto rtp_len = SecMedia::GeneHWSecritySEI( + sei, Handle->track_type, 1, len - offset, sign_len, sign, (char *) sei_head, sei_len); + rtp_len = add_racing_code(sei_race, sei + sei_len, rtp_len - sei_len); + memcpy(sei + sei_len, sei_race, rtp_len); + rtp_len += sei_len; SUCSL("success sign!!!!!!!!!! sei package\n"); - send_rtp(Handle,(char *) sei,rtp_len,tcp,param); + send_rtp(Handle, (char *) sei, rtp_len, tcp, param); // Handle->seq_accu++; } + // void none_sign_data(HWsign* Handle,uint8_t offset,int tcp,void * param,const char * sei_head){ // uint8_t sei[1024]; // auto rtp_len=SecMedia::GeneHWSecritySEI(sei,Handle->track_type,0,0,64,nullptr,(char *)sei_head, Handle->sei_len); @@ -386,25 +406,29 @@ void sign_data(HWsign* Handle,const char * buf, const uint32_t len,uint8_t offse // WRNGL("Warning!!!!!!!!!! none sei package\n"); // send_rtp(Handle,(char *) sei,rtp_len,tcp,param); // } -int HWSign_rtp_out(void* Handle, char * buf, uint32_t * len, void ** param){ - HWsign* HWSign_hd=(HWsign*) Handle; - if(!HWSign_hd) return -1; +int +HWSign_rtp_out(void *Handle, char *buf, uint32_t *len, void **param) +{ + HWsign *HWSign_hd = (HWsign *) Handle; + if (!HWSign_hd) return -1; // if (HWSign_hd->buff_que->empty()) return -1; - auto element= HWSign_hd->buff_que->pop(); + auto element = HWSign_hd->buff_que->pop(); if (!element.first || element.first->empty()) return -1; - *len=(uint32_t) element.first->size(); - memcpy(buf,element.first->data(),*len); - *param=element.second; + *len = (uint32_t) element.first->size(); + memcpy(buf, element.first->data(), *len); + *param = element.second; HWSign_hd->out++; - DEBUGL("\nHWSign: in %d out %d \n",HWSign_hd->in,HWSign_hd->out); + DEBUGL("\nHWSign: in %d out %d \n", HWSign_hd->in, HWSign_hd->out); return 1; } -void flush_all(HWsign* HWSign_hd){ - auto rtp_list=*(HWSign_hd->rtp_buff); - for(auto& rtp_sig : rtp_list){ - HWSign_hd->rtp_cb(rtp_sig.first->data(),rtp_sig.first->size(),rtp_sig.second); +void +flush_all(HWsign *HWSign_hd) +{ + auto rtp_list = *(HWSign_hd->rtp_buff); + for (auto &rtp_sig : rtp_list) { + HWSign_hd->rtp_cb(rtp_sig.first->data(), rtp_sig.first->size(), rtp_sig.second); // send_rtp(HWSign_hd,rtp_sig.first->data(),rtp_sig.first->size(),HWSign_hd->tcp,rtp_sig.second); } HWSign_hd->buff->clear(); @@ -412,126 +436,126 @@ void flush_all(HWsign* HWSign_hd){ DEBUGL("flush all!!!!!!!!!! \n"); } -int HWSign_rtp_264(HWsign* HWSign_hd, const char * buf, const uint32_t len,int tcp, void * param){ +int +HWSign_rtp_264(HWsign *HWSign_hd, const char *buf, const uint32_t len, int tcp, void *param) +{ uint8_t offset; - if (tcp) offset=16; - else offset=12; + if (tcp) + offset = 16; + else + offset = 12; - const char * rtp=buf+offset; - int length = len- offset; + const char *rtp = buf + offset; + int length = len - offset; int nal_type = *rtp & 0x1F; int nal_suffix = *rtp & (~0x1F); - - uint16_t now_seq= get_sequence(buf,tcp); + + uint16_t now_seq = get_sequence(buf, tcp); DEBUGL("\n###### input ##########################"); // print_rtp2(buf,len,offset); // send_rtp(HWSign_hd,buf,len,tcp,id); // return 1; // HWSign_hd->rtp_cb(buf,len,id); // return 1; - TRACEL("nal_type:%d\n",nal_type); - if (nal_type == 5 || nal_type == 7 || nal_type == 8 ) { + TRACEL("nal_type:%d\n", nal_type); + if (nal_type == 5 || nal_type == 7 || nal_type == 8) { //a full frame // send_rtp(HWSign_hd,buf,len,tcp,id); - HWSign_hd->rtp_cb(buf,len,param); + HWSign_hd->rtp_cb(buf, len, param); return 1; } - switch (nal_type){ - case 6:{ - NOTICEL("SEI!!!!!!!!!! package\n"); - NOTICEL("main cpu:%d\n",sched_getcpu()); - if(len<1300){ - - std::unique_lock lock(HWSign_hd->sign_mtx); - if (!HWSign_hd->buff->empty()) - { - if(HWSign_hd->I_seq==-5) - GenSEI(HWSign_hd,buf,len,param); - else - WRNGL("Sign not complete\n"); + switch (nal_type) { + case 6: { + NOTICEL("SEI!!!!!!!!!! package\n"); + NOTICEL("main cpu:%d\n", sched_getcpu()); + if (len < 1300) { - HWSign_hd->I_seq=-1; - HWSign_hd->buff->clear(); - return -1; - }else - { - WRNGL("Without Sign data\n"); - - } - + std::unique_lock lock(HWSign_hd->sign_mtx); + if (!HWSign_hd->buff->empty()) { + if (HWSign_hd->I_seq == -5) + GenSEI(HWSign_hd, buf, len, param); + else + WRNGL("Sign not complete\n"); + + HWSign_hd->I_seq = -1; + HWSign_hd->buff->clear(); + return -1; + } else { + WRNGL("Without Sign data\n"); } - HWSign_hd->I_seq=-1; - HWSign_hd->rtp_cb(buf,len,param); + } + HWSign_hd->I_seq = -1; + HWSign_hd->rtp_cb(buf, len, param); + return 1; + } + case 28: { + FU fu; + MakeFU((uint8_t) rtp[1], fu); + + if (fu.type != 5) { + HWSign_hd->rtp_cb(buf, len, param); + // send_rtp(HWSign_hd,buf,len,tcp,param); return 1; } - case 28:{ - FU fu; - MakeFU((uint8_t)rtp[1], fu); - if (fu.type!=5) - { - HWSign_hd->rtp_cb(buf,len,param); - // send_rtp(HWSign_hd,buf,len,tcp,param); - return 1; + // HWSign_hd->rtp_cb(buf,len,param); + // return 1; + // TRACEL("%u,%u",fu.type,fu.S); + if (fu.S) {//第一个rtp包 + std::unique_lock lock(HWSign_hd->sign_mtx); + if (!HWSign_hd->buff->empty()) { + WRNGL("Warning!!!!!!!!!! missing sei package\n"); + HWSign_hd->buff->clear(); } - - // HWSign_hd->rtp_cb(buf,len,param); - // return 1; - // TRACEL("%u,%u",fu.type,fu.S); - if (fu.S) { //第一个rtp包 - std::unique_lock lock(HWSign_hd->sign_mtx); - if(!HWSign_hd->buff->empty()){ - WRNGL("Warning!!!!!!!!!! missing sei package\n"); - HWSign_hd->buff->clear(); - } - INFOL("!!!!!!!!!! I head\n"); - HWSign_hd->I_seq=now_seq; - HWSign_hd->buff->assign(rtp+2,length-2); - HWSign_hd->rtp_cb(buf,len,param); - return 1; - } - - if(HWSign_hd->I_seq+1==now_seq){ - HWSign_hd->I_seq=now_seq; - - HWSign_hd->buff->append(rtp+2,length-2); - HWSign_hd->rtp_cb(buf,len,param); - if (!fu.E) { //中间rtp包 - return 1; - } - INFOL("!!!!!!!!!! I END\n"); - // flush_all(HWSign_hd); - HWSign_hd->I_seq=-2; //complete - - HWSign_hd->sign_start.notify_all(); - return 1; - }else{ - HWSign_hd->rtp_cb(buf,len,param); - return 1; - } - - + INFOL("!!!!!!!!!! I head\n"); + HWSign_hd->I_seq = now_seq; + HWSign_hd->buff->assign(rtp + 2, length - 2); + HWSign_hd->rtp_cb(buf, len, param); + return 1; } - default:{ - HWSign_hd->rtp_cb(buf,len,param); + + if (HWSign_hd->I_seq + 1 == now_seq) { + HWSign_hd->I_seq = now_seq; + + HWSign_hd->buff->append(rtp + 2, length - 2); + HWSign_hd->rtp_cb(buf, len, param); + if (!fu.E) {//中间rtp包 + return 1; + } + INFOL("!!!!!!!!!! I END\n"); + // flush_all(HWSign_hd); + HWSign_hd->I_seq = -2;//complete + + HWSign_hd->sign_start.notify_all(); + return 1; + } else { + HWSign_hd->rtp_cb(buf, len, param); return 1; } } + default: { + HWSign_hd->rtp_cb(buf, len, param); + return 1; + } + } } - -int HWSign_rtp_265(HWsign* HWSign_hd, const char * buf, const uint32_t len,int tcp, void * param){ +int +HWSign_rtp_265(HWsign *HWSign_hd, const char *buf, const uint32_t len, int tcp, void *param) +{ uint8_t offset; - if (tcp) offset=16; - else offset=12; + if (tcp) + offset = 16; + else + offset = 12; - const char * rtp=buf+offset; - int length = len- offset; + const char *rtp = buf + offset; + int length = len - offset; int nal_type = H265_TYPE(*rtp); // int nal_suffix = *rtp & (~0x1F); - - uint16_t now_seq= get_sequence(buf,tcp); + + uint16_t now_seq = get_sequence(buf, tcp); DEBUGL("\n###### input ########################## nal: %d ", nal_type); // print_rtp2(buf,len,offset); // send_rtp(HWSign_hd,buf,len,tcp,id); @@ -539,206 +563,210 @@ int HWSign_rtp_265(HWsign* HWSign_hd, const char * buf, const uint32_t len,int t // HWSign_hd->rtp_cb(buf,len,id); // return 1; - switch (nal_type){ - case H265Nal::NAL_SEI_PREFIX:{ - NOTICEL("SEI!!!!!!!!!! package\n"); - NOTICEL("main cpu:%d\n",sched_getcpu()); - if(len<1300){ - - std::unique_lock lock(HWSign_hd->sign_mtx); - if (!HWSign_hd->buff->empty()) - { - if(HWSign_hd->I_seq==-5) - GenSEI(HWSign_hd,buf,len,param); - else - if(HWSign_hd->I_seq==-2) - WRNGL("Sign not complete\n"); - else - WRNGL("non Sign\n"); + switch (nal_type) { + case H265Nal::NAL_SEI_PREFIX: { + NOTICEL("SEI!!!!!!!!!! package\n"); + NOTICEL("main cpu:%d\n", sched_getcpu()); + if (len < 1300) { - HWSign_hd->I_seq=-1; - HWSign_hd->buff->clear(); - return -1; - }else - { - WRNGL("Without Sign data\n"); - - } - + std::unique_lock lock(HWSign_hd->sign_mtx); + if (!HWSign_hd->buff->empty()) { + if (HWSign_hd->I_seq == -5) + GenSEI(HWSign_hd, buf, len, param); + else if (HWSign_hd->I_seq == -2) + WRNGL("Sign not complete\n"); + else + WRNGL("non Sign\n"); + + HWSign_hd->I_seq = -1; + HWSign_hd->buff->clear(); + return -1; + } else { + WRNGL("Without Sign data\n"); } - HWSign_hd->I_seq=-1; - HWSign_hd->rtp_cb(buf,len,param); + } + HWSign_hd->I_seq = -1; + HWSign_hd->rtp_cb(buf, len, param); + return 1; + } + case 49: { + FU fu; + Make265FU((uint8_t) rtp[2], fu); + + if (!(fu.type >= H265Nal::NAL_IDR_W_RADL && fu.type <= H265Nal::NAL_IDR_N_LP)) { + HWSign_hd->rtp_cb(buf, len, param); + // send_rtp(HWSign_hd,buf,len,tcp,param); return 1; } - case 49:{ - FU fu; - Make265FU((uint8_t)rtp[2], fu); + // HWSign_hd->rtp_cb(buf,len,param); + // return 1; - if (!(fu.type>=H265Nal::NAL_IDR_W_RADL && fu.type<=H265Nal::NAL_IDR_N_LP)) - { - HWSign_hd->rtp_cb(buf,len,param); - // send_rtp(HWSign_hd,buf,len,tcp,param); - return 1; + if (fu.S) {//第一个rtp包 + std::unique_lock lock(HWSign_hd->sign_mtx); + if (!HWSign_hd->buff->empty()) { + WRNGL("Warning!!!!!!!!!! missing package\n"); + HWSign_hd->buff->clear(); } - // HWSign_hd->rtp_cb(buf,len,param); - // return 1; - - if (fu.S) { //第一个rtp包 - std::unique_lock lock(HWSign_hd->sign_mtx); - if(!HWSign_hd->buff->empty()){ - WRNGL("Warning!!!!!!!!!! missing package\n"); - HWSign_hd->buff->clear(); - } - DEBUGL("!!!!!!!!!! I head\n"); - HWSign_hd->I_seq=now_seq; - HWSign_hd->buff->assign(rtp+3,length-3); - HWSign_hd->rtp_cb(buf,len,param); - return 1; - } - - if(HWSign_hd->I_seq+1==now_seq){ - HWSign_hd->I_seq=now_seq; - HWSign_hd->buff->append(rtp+3,length-3); - HWSign_hd->rtp_cb(buf,len,param); - if (!fu.E) { //中间rtp包 - return 1; - } - - HWSign_hd->I_seq=-2; //complete - - HWSign_hd->sign_start.notify_all(); - // SUCSL("Notify sign\n"); - return 1; - }else{ - HWSign_hd->rtp_cb(buf,len,param); - return 1; - } - - + DEBUGL("!!!!!!!!!! I head\n"); + HWSign_hd->I_seq = now_seq; + HWSign_hd->buff->assign(rtp + 3, length - 3); + HWSign_hd->rtp_cb(buf, len, param); + return 1; } - default:{ - HWSign_hd->rtp_cb(buf,len,param); + + if (HWSign_hd->I_seq + 1 == now_seq) { + HWSign_hd->I_seq = now_seq; + HWSign_hd->buff->append(rtp + 3, length - 3); + HWSign_hd->rtp_cb(buf, len, param); + if (!fu.E) {//中间rtp包 + return 1; + } + + HWSign_hd->I_seq = -2;//complete + + HWSign_hd->sign_start.notify_all(); + // SUCSL("Notify sign\n"); + return 1; + } else { + HWSign_hd->rtp_cb(buf, len, param); return 1; } } + default: { + HWSign_hd->rtp_cb(buf, len, param); + return 1; + } + } } -int HWSign_rtp_input(void* Handle, const char * buf, const uint32_t len, void * param){ - int ret=-1; - HWsign* HWSign_hd=(HWsign*) Handle; - if(!HWSign_hd || !HWSign_hd->rtp_cb || !HWSign_hd->sm3_hd || !HWSign_hd->sm2_hd || !HWSign_hd->buff || !HWSign_hd->buff_que) { +int +HWSign_rtp_input(void *Handle, const char *buf, const uint32_t len, void *param) +{ + int ret = -1; + HWsign *HWSign_hd = (HWsign *) Handle; + if (!HWSign_hd || !HWSign_hd->rtp_cb || !HWSign_hd->sm3_hd || !HWSign_hd->sm2_hd || !HWSign_hd->buff + || !HWSign_hd->buff_que) { throw runtime_error("HWSign_rtp initial error"); return -1; } HWSign_hd->in++; - DEBUGL("input: in %d que %ld out %d \n",HWSign_hd->in,HWSign_hd->buff_que->size(),HWSign_hd->out); + DEBUGL("input: in %d que %ld out %d \n", HWSign_hd->in, HWSign_hd->buff_que->size(), HWSign_hd->out); - HWSign_hd->tcp=0; - uint8_t offset=12; + HWSign_hd->tcp = 0; + uint8_t offset = 12; - if (len<=offset) { - HWSign_hd->rtp_cb(buf,len,param); + if (len <= offset) { + HWSign_hd->rtp_cb(buf, len, param); return 1; } - if((uint8_t)buf[0]!=0x80){ + if ((uint8_t) buf[0] != 0x80) { WRNGL("Not RTP Package\n"); - HWSign_hd->rtp_cb(buf,len,param); + HWSign_hd->rtp_cb(buf, len, param); return 1; } + uint8_t payload_type = buf[1] & 0x7f; - uint8_t payload_type=buf[1]& 0x7f; - - switch (payload_type) - { - case 99: //h264 - if (HWSign_hd->track_type!=CodecId::CodecH264) - { - HWSign_hd->track_type=CodecId::CodecH264; + switch (payload_type) { + case 99://h264 + if (HWSign_hd->track_type != CodecId::CodecH264) { + HWSign_hd->track_type = CodecId::CodecH264; DEBUGL("Track type is changed to H.264"); } - ret=HWSign_rtp_264(HWSign_hd,buf,len,0,param); + ret = HWSign_rtp_264(HWSign_hd, buf, len, 0, param); break; - case 103 ... 108: //h265 - if (HWSign_hd->track_type!=CodecId::CodecH265) - { - HWSign_hd->track_type=CodecId::CodecH265; + case 103 ... 108://h265 + if (HWSign_hd->track_type != CodecId::CodecH265) { + HWSign_hd->track_type = CodecId::CodecH265; DEBUGL("Track type is changed to H.265"); } - ret=HWSign_rtp_265(HWSign_hd,buf,len,0,param); + ret = HWSign_rtp_265(HWSign_hd, buf, len, 0, param); break; - case 0 ... 95: // standard type - HWSign_hd->rtp_cb(buf,len,param); + case 0 ... 95:// standard type + HWSign_hd->rtp_cb(buf, len, param); break; default: - HWSign_hd->rtp_cb(buf,len,param); - WRNGL("Error !!!!!!!!!! Unsupport track type: %u \n",payload_type); + HWSign_hd->rtp_cb(buf, len, param); + WRNGL("Error !!!!!!!!!! Unsupport track type: %u \n", payload_type); break; } - return 1; } -int genSECset(HWsign * HWptr,struct sec_set_info * sign_info){ +int +genSECset(HWsign *HWptr, struct sec_set_info *sign_info) +{ + uint8_t security_set_version[19] = "Ver 0.0.2"; + memset(&HWptr->sec_set, 0, sizeof(HWptr->sec_set)); + HWptr->sec_set.Flag.encryption_flag = 0; + HWptr->sec_set.Flag.authnetication_flag = 1; + HWptr->sec_set.Flag.vek_flag = 0; + HWptr->sec_set.Flag.iv_flag = 0; + HWptr->sec_set.Flag.hash_discard_p_picture = 1; + HWptr->sec_set.Flag.reserved_flag = 0b001; - uint8_t security_set_version[19] = "Ver 0.0.2"; - memset(&HWptr->sec_set,0,sizeof(HWptr->sec_set)); - HWptr->sec_set.Flag.encryption_flag = 0; - HWptr->sec_set.Flag.authnetication_flag = 1; - HWptr->sec_set.Flag.vek_flag = 0; - HWptr->sec_set.Flag.iv_flag = 0; - HWptr->sec_set.Flag.hash_discard_p_picture = 1; - HWptr->sec_set.Flag.reserved_flag = 0b001; + HWptr->sec_set.Type.signature_type = (uint8_t) SecMedia::DecryptType::SM2_auth; + HWptr->sec_set.Type.hash_type = (uint8_t) SecMedia::DecryptType::SM3; + HWptr->sec_set.Type.encryption_type = (uint8_t) SecMedia::DecryptType::NONE; + HWptr->sec_set.Type.vek_encryption_type = (uint8_t) SecMedia::DecryptType::NONE; - HWptr->sec_set.Type.signature_type = (uint8_t) SecMedia::DecryptType::SM2_auth; - HWptr->sec_set.Type.hash_type =(uint8_t) SecMedia::DecryptType::SM3; - HWptr->sec_set.Type.encryption_type =(uint8_t) SecMedia::DecryptType::NONE; - HWptr->sec_set.Type.vek_encryption_type = (uint8_t) SecMedia::DecryptType::NONE; + memcpy(HWptr->sec_set.camera_id, sign_info->camera_id, 20); - memcpy(HWptr->sec_set.camera_id, sign_info->camera_id, 20); + HWptr->sec_set.vkek_version_length_minus1 = 31;//@@在加密复用中：为视频密钥长度 + //////////////////////////////////////////// + memcpy(HWptr->sec_set.vkek_version, sign_info->vkek_version, 32); + HWptr->sec_set.end_flag = 0x80; - HWptr->sec_set.vkek_version_length_minus1 = 31; //@@在加密复用中：为视频密钥长度 - //////////////////////////////////////////// - memcpy(HWptr->sec_set.vkek_version, sign_info->vkek_version, 32); - HWptr->sec_set.end_flag=0x80; - - /////////////////////ver set - - memset(&HWptr->ver_set,0,sizeof(HWptr->ver_set)); - HWptr->ver_set.end_flag=0x80; - return 1; + /////////////////////ver set + memset(&HWptr->ver_set, 0, sizeof(HWptr->ver_set)); + HWptr->ver_set.end_flag = 0x80; + return 1; } - -void * HWSign_tcp_init(struct sec_set_info * sign_info){ - HWsec * HWsec_ptr= new HWsec(sign_info); - return (void*) HWsec_ptr; +void * +HWSign_tcp_init(struct sec_set_info *sign_info) +{ + HWsec *HWsec_ptr = new HWsec(sign_info); + return (void *) HWsec_ptr; } -void HWSign_tcp_release(void* Handle){ - delete (HWsec *)Handle; -} -int HWSign_tcp_rtp_input(void* Handle, const char * buf, const uint32_t len, void * param){ - HWsec * HWsec_ptr=(HWsec * )Handle; - if(!HWsec_ptr || !HWsec_ptr->check_class()) { - if(!HWsec_ptr) ERROL("HWSign_tcp_rtp_input NULL Handle"); - if(!HWsec_ptr->check_class()) ERROL("HWSign_tcp_rtp Wrong Type Handle"); +void +HWSign_tcp_release(void *Handle) +{ + delete (HWsec *) Handle; +} + +int +HWSign_tcp_rtp_input(void *Handle, const char *buf, const uint32_t len, void *param) +{ + + HWsec *HWsec_ptr = (HWsec *) Handle; + if (!HWsec_ptr || !HWsec_ptr->check_class()) { + if (!HWsec_ptr) ERROL("HWSign_tcp_rtp_input NULL Handle"); + if (!HWsec_ptr->check_class()) ERROL("HWSign_tcp_rtp Wrong Type Handle"); throw runtime_error("HWSign_tcp_rtp initial error"); } - HWsec_ptr->HWsec_input((uint8_t*)buf,len,param); + HWsec_ptr->HWsec_input((uint8_t *) buf, len, param); return 1; } -int HWSign_tcp_rtp_out(void* Handle, char * buf, uint32_t * len,uint16_t* sei_end_offset,uint16_t* append_length, void ** param){ - HWsec * HWsec_ptr=(HWsec * )Handle; - if(!HWsec_ptr || !HWsec_ptr->check_class()) { - if(!HWsec_ptr) ERROL("HWSign_tcp_rtp_out NULL Handle"); - if(!HWsec_ptr->check_class()) ERROL("HWSign_tcp_rtp_out Wrong Type Handle"); + +int +HWSign_tcp_rtp_out(void *Handle, + char *buf, + uint32_t *len, + uint16_t *sei_end_offset, + uint16_t *append_length, + void **param) +{ + HWsec *HWsec_ptr = (HWsec *) Handle; + if (!HWsec_ptr || !HWsec_ptr->check_class()) { + if (!HWsec_ptr) ERROL("HWSign_tcp_rtp_out NULL Handle"); + if (!HWsec_ptr->check_class()) ERROL("HWSign_tcp_rtp_out Wrong Type Handle"); throw runtime_error("HWSign_tcp_rtp_out initial error"); } - return HWsec_ptr->HWsec_output(buf,len,sei_end_offset,append_length, param); + return HWsec_ptr->HWsec_output(buf, len, sei_end_offset, append_length, param); } - diff --git a/src/HuaWei/HWsign.h b/src/HuaWei/HWsign.h index fb55274..912e5aa 100644 --- a/src/HuaWei/HWsign.h +++ b/src/HuaWei/HWsign.h @@ -2,41 +2,58 @@ #ifndef _HWSIGN_H #define _HWSIGN_H -#include -#include +#include +#include +#include //#include #define API_EXPORT __attribute__((visibility("default"))) -struct sec_set_info{ +struct sec_set_info { uint8_t cpu_core; - uint8_t camera_id[21]; - uint8_t vkek_version[32]; // 秘钥的加密秘钥的版本号 + uint8_t camera_id[21]; + uint8_t vkek_version[32];// 秘钥的加密秘钥的版本号 uint8_t prikey_size; uint8_t pubkey_size; - uint8_t prikey[64]; - uint8_t pubkey[128]; + uint8_t prikey[64]; + uint8_t pubkey[128]; }; + // void * HWSign_init(const std::function rtp_callback); API_EXPORT int SDF_Device_open(); API_EXPORT int SDF_Device_close(); -API_EXPORT void * GB28181_stream_init(struct sec_set_info * sign_info); -API_EXPORT int GB28181_stream_in(void* Handle, const char * buf, const uint32_t len, void * param); -API_EXPORT void GB28181_stream_release(void* Handle); -API_EXPORT int GB28181_stream_out(void* Handle, char * buf, uint32_t * len, uint16_t* sei_end_offset,uint16_t* append_length,void ** param); +API_EXPORT void *HK_stream_init(struct sec_set_info *sign_info); +API_EXPORT int HK_stream_in(void *Handle, const char *buf, const uint32_t len, void *param); +API_EXPORT void HK_stream_release(void *Handle); +API_EXPORT int +KH_stream_out(void *Handle, char *buf, uint32_t *len, uint16_t *sei_end_offset, uint16_t *append_length, void **param); -API_EXPORT void * HWSign_init(struct sec_set_info * sign_info); -API_EXPORT void HWSign_release(void* Handle); -API_EXPORT int HWSign_rtp_input(void* Handle, const char * buf, const uint32_t len, void * param); -API_EXPORT int HWSign_rtp_out(void* Handle, char * buf, uint32_t * len, void ** param); +API_EXPORT void *GB28181_stream_init(struct sec_set_info *sign_info); +API_EXPORT int GB28181_stream_in(void *Handle, const char *buf, const uint32_t len, void *param); +API_EXPORT void GB28181_stream_release(void *Handle); +API_EXPORT int GB28181_stream_out(void *Handle, + char *buf, + uint32_t *len, + uint16_t *sei_end_offset, + uint16_t *append_length, + void **param); -API_EXPORT void * HWSign_tcp_init(struct sec_set_info * sign_info); -API_EXPORT void HWSign_tcp_release(void* Handle); -API_EXPORT int HWSign_tcp_rtp_input(void* Handle, const char * buf, const uint32_t len, void * param); -API_EXPORT int HWSign_tcp_rtp_out(void* Handle, char * buf, uint32_t * len, uint16_t* sei_end_offset,uint16_t* append_length,void ** param); +API_EXPORT void *HWSign_init(struct sec_set_info *sign_info); +API_EXPORT void HWSign_release(void *Handle); +API_EXPORT int HWSign_rtp_input(void *Handle, const char *buf, const uint32_t len, void *param); +API_EXPORT int HWSign_rtp_out(void *Handle, char *buf, uint32_t *len, void **param); +API_EXPORT void *HWSign_tcp_init(struct sec_set_info *sign_info); +API_EXPORT void HWSign_tcp_release(void *Handle); +API_EXPORT int HWSign_tcp_rtp_input(void *Handle, const char *buf, const uint32_t len, void *param); +API_EXPORT int HWSign_tcp_rtp_out(void *Handle, + char *buf, + uint32_t *len, + uint16_t *sei_end_offset, + uint16_t *append_length, + void **param); -API_EXPORT void * HWVerify_init(); -API_EXPORT void HWVerify_release(void* Handle); -API_EXPORT int HWVerify_rtp_input(void* Handle, const char * buf, const uint32_t len,int tcp, void * param); +API_EXPORT void *HWVerify_init(); +API_EXPORT void HWVerify_release(void *Handle); +API_EXPORT int HWVerify_rtp_input(void *Handle, const char *buf, const uint32_t len, int tcp, void *param); #endif /* _DECRYPT_H */ diff --git a/src/base/event.h b/src/base/event.h new file mode 100644 index 0000000..90bd785 --- /dev/null +++ b/src/base/event.h @@ -0,0 +1,47 @@ +#ifndef AW_SECURITY_MEDIA_LIB_BASE_EVENT_H +#define AW_SECURITY_MEDIA_LIB_BASE_EVENT_H + +#pragma once +#include +#include +#include + +namespace sign { +class Event { +public: + Event(bool signaled = false) { Reset(signaled); } + + bool Signaled() const + { + std::lock_guard _(_lock); + return _signaled; + } + + void Wait() + { + std::unique_lock _(_lock); + _cv.wait(_, [this] { return _signaled; }); + } + + void Reset(bool signaled = false) + { + std::lock_guard _(_lock); + _signaled = signaled; + if (_signaled) { _cv.notify_all(); } + } + + void Signal() + { + std::lock_guard _(_lock); + _signaled = true; + _cv.notify_all(); + } + +private: + mutable std::mutex _lock; + bool _signaled{false}; + std::condition_variable _cv; +}; +}// namespace sign + +#endif// AW_SECURITY_MEDIA_LIB_BASE_EVENT_H diff --git a/src/base/frame.cpp b/src/base/frame.cpp new file mode 100644 index 0000000..1b71a7c --- /dev/null +++ b/src/base/frame.cpp @@ -0,0 +1,28 @@ +#include "frame.h" +#include "HuaWei/HWcommon.h" +#include + +namespace sign { + +static std::atomic g_frame_cnt{0}; + +Frame::~Frame() { g_frame_cnt.fetch_sub(1); } + +Frame::Ptr +Frame::CreateUDPFrame(const uint8_t *data, size_t len) +{ + return std::shared_ptr(new Frame(kUDP, data, len)); +} + +Frame::Ptr +Frame::CreateTCPFrame(const uint8_t *data, size_t len) +{ + return std::shared_ptr(new Frame(kTCP, data, len)); +} + +Frame::Frame(Type type, const uint8_t *data, size_t len) : _type(type), _data(data, data + len) +{ + auto cur = g_frame_cnt.fetch_add(1); + // INFOL("frame count: %d\n", cur); +} +}// namespace sign diff --git a/src/base/frame.h b/src/base/frame.h new file mode 100644 index 0000000..1d3e6ae --- /dev/null +++ b/src/base/frame.h @@ -0,0 +1,53 @@ +#ifndef AW_SECURITY_MEDIA_LIB_BASE_FRAME_H +#define AW_SECURITY_MEDIA_LIB_BASE_FRAME_H + +#pragma once +#include "base/event.h" +#include +#include + +namespace sign { +class Frame : std::enable_shared_from_this { +public: + using Ptr = std::shared_ptr; + + enum Type { kTCP, kUDP }; + + static Ptr CreateUDPFrame(const uint8_t *data, size_t len); + static Ptr CreateTCPFrame(const uint8_t *data, size_t len); + +public: + ~Frame(); + + Type type() const { return _type; } + + const uint8_t *data() const { return _data.data(); } + + uint8_t *data() { return _data.data(); } + + size_t size() const { return _data.size(); } + + // 用户附加的参数 + void set_user_data(void *param) { _user_data = param; } + + void *user_data() const { return _user_data; } + + bool paused() const { return !_event.Signaled(); } + + // signaled -> unpaused + void set_paused(bool paused) { _event.Reset(!paused); } + + void Wait() { _event.Wait(); } + +private: + Frame(Type type, const uint8_t *data, size_t len); + +private: + Event _event{true}; + Type _type; + std::vector _data; + void *_user_data; +}; +}// namespace sign + +#endif// AW_SECURITY_MEDIA_LIB_BASE_FRAME_H diff --git a/src/base/frame_manager.cpp b/src/base/frame_manager.cpp new file mode 100644 index 0000000..2b4126d --- /dev/null +++ b/src/base/frame_manager.cpp @@ -0,0 +1,48 @@ +#include "frame_manager.h" +#include "HuaWei/HWcommon.h" + +namespace sign { + +FrameManager::FrameManager() { Init(); } + +FrameManager::~FrameManager() {} + +bool +FrameManager::Enqueue(Frame::Ptr frame) +{ + + std::lock_guard _(_frame_queue_lock); + OnFrameEnqueue(frame); + _frame_queue.push(frame); + return true; +} + +Frame::Ptr +FrameManager::Dequeue() +{ + Frame::Ptr frame{nullptr}; + { + std::lock_guard _(_frame_queue_lock); + if (_frame_queue.empty()) { return nullptr; } + frame = _frame_queue.front(); + _frame_queue.pop(); + OnFrameDequeue(frame); + } + + frame->Wait(); + return frame; +} + +void +FrameManager::SetSecSetInfo(sec_set_info *info) +{ + _rtp_manager.SetSecSetInfo(info); +} + +void +FrameManager::Init() +{ + OnFrameEnqueue.connect(&_rtp_manager, &RTPManager::OnFrameEnqueue); +} + +}// namespace sign diff --git a/src/base/frame_manager.h b/src/base/frame_manager.h new file mode 100644 index 0000000..8131022 --- /dev/null +++ b/src/base/frame_manager.h @@ -0,0 +1,39 @@ +#ifndef AW_SECURITY_MEDIA_LIB_BASE_FRAME_MANAGER_H +#define AW_SECURITY_MEDIA_LIB_BASE_FRAME_MANAGER_H + +#pragma once + +#include "HuaWei/HWsign.h" +#include "base/frame.h" +#include "base/rtp_manager.h" +#include "sigslot.h" +#include +#include + +namespace sign { +class FrameManager { +public: + sigslot::signal1 OnFrameEnqueue; + sigslot::signal1 OnFrameDequeue; + + FrameManager(); + ~FrameManager(); + + bool Enqueue(Frame::Ptr frame); + Frame::Ptr Dequeue(); + + // HACK: 透传参数 + void SetSecSetInfo(sec_set_info *info); + +private: + void Init(); + +private: + RTPManager _rtp_manager; + + std::mutex _frame_queue_lock; + std::queue _frame_queue; +}; +}// namespace sign + +#endif// AW_SECURITY_MEDIA_LIB_BASE_FRAME_MANAGER_H diff --git a/src/base/rtp_decoder.cpp b/src/base/rtp_decoder.cpp new file mode 100644 index 0000000..6354049 --- /dev/null +++ b/src/base/rtp_decoder.cpp @@ -0,0 +1,102 @@ +#include "rtp_decoder.h" +#include "HuaWei/HWcommon.h" +#include "util.h" + +namespace sign { + +RTPDecoder::Ptr +RTPDecoder::Create(int payload_type, const char *encoding) +{ + auto decoder = std::shared_ptr(new RTPDecoder(payload_type, encoding)); + if (decoder->Initialize()) { + return decoder; + } else { + ERROL("RTPDecoder initialize failed. payload_type=%d, encoding=%s\n", payload_type, encoding); + return nullptr; + } +} + +RTPDecoder::~RTPDecoder() {} + +bool +RTPDecoder::Initialize() +{ + _handler = CreateHandler(); + _decoder = CreateDecoder(_handler); + return _handler && _decoder; +} + +void +RTPDecoder::Input(RTPPacket::Ptr packet) +{ + if (packet->packet_size() < 12) { + WRNGL("RTP packet length is too short. len=%lu\n", packet->packet_size()); + return; + } + + const uint8_t pt = GetRTPPayloadType(packet->packet_data()); + if (pt != _payload_type) { + // WRNGL("RTP packet payload type is mismatch. discard it. pt=%d, _payload_type=%d\n", pt, _payload_type); + return; + } + + const uint16_t seq = GetRTPSequenceNumber(packet->packet_data()); + if (_prev_seq == -1) { + _prev_seq = seq; + } else if (seq != ((_prev_seq + 1) & 0xFFFF)) { + _ref_rtp_packets.clear(); + _prev_seq = -1; + return; + } else { + _prev_seq = seq; + } + + _ref_rtp_packets.push_back(packet); + auto ret = rtp_payload_decode_input(_decoder.get(), packet->packet_data(), packet->packet_size()); + if (ret < 1) { _ref_rtp_packets.pop_back(); } +} + +RTPDecoder::RTPDecoder(int payload_type, const char *encoding) : _payload_type(payload_type), _encoding(encoding) {} + +std::shared_ptr +RTPDecoder::CreateHandler() +{ + auto handler = std::make_shared(); + + handler->alloc = [](void *clazz, int bytes) -> void * { + auto self = (RTPDecoder *) clazz; + auto &buf = self->_buffer; + if (buf.size() < bytes) { + buf.resize(bytes); + } else if (buf.capacity() > 2 * bytes && bytes > 2048) { + buf.shrink_to_fit(); + } + + return buf.data(); + }; + + handler->free = [](void *clazz, void *packet) {}; + + handler->packet = [](void *clazz, const void *packet, int bytes, uint32_t timestamp, int flags) { + auto self = (RTPDecoder *) clazz; + int type = 0x1F & ((uint8_t *) packet)[0]; + // INFOL("RTPDecoder::CreateHandler packet timestamp=%u, bytes=%d, flags=%d type=%d\n", timestamp, bytes, flags, + // type); + // std::string hex = ToHex((const uint8_t *) packet, bytes); + // INFOL("Data: %s\n", hex.c_str()); + DecodedPacket dp{packet, bytes, timestamp, flags}; + dp.ref_rtp_packets.swap(self->_ref_rtp_packets); + + self->OnDecoded(dp); + }; + return handler; +} + +std::shared_ptr +RTPDecoder::CreateDecoder(std::shared_ptr handler) +{ + auto rtp_decoder = rtp_payload_decode_create(_payload_type, _encoding.c_str(), handler.get(), this); + return std::shared_ptr(rtp_decoder, rtp_payload_decode_destroy); +} + +}// namespace sign diff --git a/src/base/rtp_decoder.h b/src/base/rtp_decoder.h new file mode 100644 index 0000000..eab719b --- /dev/null +++ b/src/base/rtp_decoder.h @@ -0,0 +1,53 @@ +#ifndef AW_SECURITY_MEDIA_LIB_BASE_RTP_DECODER_H +#define AW_SECURITY_MEDIA_LIB_BASE_RTP_DECODER_H + +#pragma once +#include "rtp-payload.h" +#include "rtp_packet.h" +#include "sigslot.h" +#include +#include +#include + +namespace sign { +class RTPDecoder { +public: + using Ptr = std::shared_ptr; + + // void (*packet)(void* param, const void *packet, int bytes, uint32_t timestamp, int flags); + struct DecodedPacket { + const void *packet; + int bytes; + uint32_t timestamp; + int flags; + std::vector ref_rtp_packets; + }; + + sigslot::signal1 OnDecoded; + + static Ptr Create(int payload_type, const char *encoding = nullptr); + +public: + ~RTPDecoder(); + bool Initialize(); + void Input(RTPPacket::Ptr packet); + +private: + RTPDecoder(int payload_type, const char *encoding); + std::shared_ptr CreateHandler(); + std::shared_ptr CreateDecoder(std::shared_ptr handler); + +private: + int _payload_type; + std::string _encoding; + int32_t _prev_seq{-1}; + + std::shared_ptr _decoder; + std::shared_ptr _handler; + std::vector _buffer; + + std::vector _ref_rtp_packets; +}; +}// namespace sign + +#endif// AW_SECURITY_MEDIA_LIB_BASE_RTP_DECODER_H diff --git a/src/base/rtp_manager.cpp b/src/base/rtp_manager.cpp new file mode 100644 index 0000000..ce0a327 --- /dev/null +++ b/src/base/rtp_manager.cpp @@ -0,0 +1,129 @@ +#include "rtp_manager.h" +#include "HuaWei/HWcommon.h" +#include "base/util.h" +#include + +namespace sign { +RTPManager::RTPManager() {} + +RTPManager::~RTPManager() {} + +void +RTPManager::OnFrameEnqueue(Frame::Ptr frame) +{ + if (frame->type() == Frame::kTCP) { + ProcessTCPFrame(frame); + } else if (frame->type() == Frame::kUDP) { + ProcessUDPFrame(frame); + } else { + // unknown + } +} + +void +RTPManager::SetSecSetInfo(sec_set_info *info) +{} + +void +RTPManager::ProcessUDPFrame(Frame::Ptr frame) +{ + if (!IsRTPHeader(frame->data(), frame->size())) { return; } + auto packet = RTPPacket::CreateCompleteRTPPacket(this, frame); + ProcessPacket(packet); +} + +void +RTPManager::ProcessTCPFrame(Frame::Ptr) +{} + +void +RTPManager::ProcessPacket(RTPPacket::Ptr packet) +{ + if (!packet->IsComplete()) { + // ERROL("RTP packet is not complete, discard it.\n"); + return; + } + + MaybeSetSSRC(packet->ssrc()); + if (packet->ssrc() != _cur_rtp_ssrc) { + WRNGL("RTP packet ssrc is mismatch. discard it. cur_ssrc=%ld, packet->ssrc=%d\n", _cur_rtp_ssrc, + packet->ssrc()); + return; + } + + MaybeSetSeq(packet->seq()); + if (packet->seq() != _cur_rtp_seq) { + // WRNGL("RTP packet seq is not continuous. cur_seq=%ld, packet->seq=%d\n", _cur_rtp_seq, packet->seq()); + SetCurSeq(packet->seq()); + } + IncCurSeq(); + + if (!_decoder) { + _decoder = RTPDecoder::Create(packet->payload_type(), "H264"); + if (_decoder) { _decoder->OnDecoded.connect(this, &RTPManager::OnRTPDecoded); } + } + if (_decoder) { _decoder->Input(packet); } + + MaybeReplaceSeq(packet); +} + +void +RTPManager::SetCurSeq(uint16_t seq) +{ + _cur_rtp_seq = seq; +} + +void +RTPManager::MaybeSetSSRC(uint32_t ssrc) +{ + if (_cur_rtp_ssrc == -1) { SetCurSSRC(ssrc); } +} + +void +RTPManager::MaybeSetSeq(uint16_t seq) +{ + if (_cur_rtp_seq == -1) { SetCurSeq(seq); } +} + +void +RTPManager::MaybeReplaceSeq(RTPPacket::Ptr packet) +{ + auto new_seq = (packet->seq() + _insert_packet_num); + packet->set_seq(new_seq); +} + +void +RTPManager::SetCurSSRC(uint32_t ssrc) +{ + _cur_rtp_ssrc = ssrc; +} + +void +RTPManager::IncCurSeq() +{ + _cur_rtp_seq = GetNextSeq(); +} + +uint16_t +RTPManager::GetNextSeq() +{ + return (_cur_rtp_seq + 1) & 0xFFFF; +} + +void +RTPManager::OnRTPDecoded(RTPDecoder::DecodedPacket packet) +{ + uint8_t h264_type = ((uint8_t *) packet.packet)[0] & 0x1F; + + // if (h264_type == 1) { return; } + std::stringstream ss; + for (auto &p : packet.ref_rtp_packets) { + ss << p->seq() << " "; + p->set_paused(false); + } + auto str = ss.str(); + if (!str.empty()) str.pop_back(); + INFOL("RTP decoded. type=%2d, size=%5u seq=[%s]\n", h264_type, packet.bytes, str.c_str()); +} + +}// namespace sign diff --git a/src/base/rtp_manager.h b/src/base/rtp_manager.h new file mode 100644 index 0000000..398d3e5 --- /dev/null +++ b/src/base/rtp_manager.h @@ -0,0 +1,65 @@ +#ifndef AW_SECURITY_MEDIA_LIB_BASE_RTP_MANAGER_H +#define AW_SECURITY_MEDIA_LIB_BASE_RTP_MANAGER_H + +#pragma once + +#include "HuaWei/HWsign.h" +#include "rtp_decoder.h" +#include "rtp_packet.h" +#include "sigslot.h" + +namespace sign { +class RTPManager : public sigslot::has_slots<> { +public: + sigslot::signal1 OnRTPPacket; + +public: + RTPManager(); + ~RTPManager(); + + void OnFrameEnqueue(Frame::Ptr frame); + + // HACK: + void SetSecSetInfo(sec_set_info *info); + +private: + void ProcessUDPFrame(Frame::Ptr); + void ProcessTCPFrame(Frame::Ptr); + + void ProcessPacket(RTPPacket::Ptr packet); + + void SetCurSeq(uint16_t seq); + void MaybeSetSSRC(uint32_t ssrc); + void MaybeSetSeq(uint16_t seq); + void MaybeReplaceSeq(RTPPacket::Ptr packet); + + void SetCurSSRC(uint32_t ssrc); + void IncCurSeq(); + uint16_t GetNextSeq(); + +private: + // FOR TEST + void OnRTPDecoded(RTPDecoder::DecodedPacket packet); + +private: + /** + * Partical RTP packet -> Complete RTP packet -> Decoder -> Signer + * + * Signer -> RTPManager: + * 1. Modify SEI + * 2. Insert SEI + **/ + + // 当前不完整的RTP包 + RTPPacket::Ptr _cur_rtp_packet{nullptr}; + int64_t _cur_rtp_seq{-1}; + int64_t _cur_rtp_ssrc{-1}; + + // 插入的包对seq有影响，需要记录插入包的数量 + uint16_t _insert_packet_num{0}; + + RTPDecoder::Ptr _decoder; +}; +}// namespace sign + +#endif// AW_SECURITY_MEDIA_LIB_BASE_RTP_MANAGER_H diff --git a/src/base/rtp_packet.cpp b/src/base/rtp_packet.cpp new file mode 100644 index 0000000..2f278b9 --- /dev/null +++ b/src/base/rtp_packet.cpp @@ -0,0 +1,134 @@ +#include "rtp_packet.h" +#include "HuaWei/HWcommon.h" +#include "util.h" +#include +#include +#include + +namespace sign { +static std::atomic g_rtp_packet_cnt{0}; + +void +IncRTPPacketCnt() +{ + auto cnt = g_rtp_packet_cnt.fetch_add(1); + // INFOL("rtp packet count: %d\n", cnt); +} + +void +DecRTPPacketCnt() +{ + g_rtp_packet_cnt.fetch_sub(1); +} + +RTPPacket::Ptr +RTPPacket::CreateParticalRTPPacket(RTPManager *owner) +{ + return std::shared_ptr(new RTPPacket(owner)); +} + +RTPPacket::Ptr +RTPPacket::CreateCompleteRTPPacket(RTPManager *owner, Frame::Ptr udp_frame) +{ + return std::shared_ptr(new RTPPacket(owner, udp_frame)); +} + +RTPPacket::~RTPPacket() +{ + set_paused(false); + DecRTPPacketCnt(); +} + +size_t +RTPPacket::packet_size() +{ + assert(_frame_type == Frame::kUDP || state() > kMissTCPHeader); + if (_frame_type == Frame::kUDP) { + return _ref_frames.front()->size(); + } else { + assert(false); + return 0; + } +} + +const uint8_t * +RTPPacket::packet_data() const +{ + return _rtp_ptr; +} + +uint8_t +RTPPacket::payload_type() const +{ + assert(state() > kMissRTPHeader); + return GetRTPPayloadType(_rtp_ptr); +} + +uint16_t +RTPPacket::seq() const +{ + assert(state() > kMissRTPHeader); + return GetRTPSequenceNumber(_rtp_ptr); +} + +uint32_t +RTPPacket::ssrc() const +{ + assert(state() > kMissRTPHeader); + return GetRTPSSRC(_rtp_ptr); +} + +uint32_t +RTPPacket::timestamp() const +{ + assert(state() > kMissRTPHeader); + return GetRTPTimestamp(_rtp_ptr); +} + +void +RTPPacket::set_seq(uint16_t seq) +{ + if (_frame_type == Frame::kUDP) { + SetRTPSequenceNumber(_rtp_ptr, seq); + } else { + assert(false); + } +} + +void +RTPPacket::AddRefFrame(Frame::Ptr frame) +{ + assert(false); +} + +bool +RTPPacket::paused() const +{ + for (auto &frame : _ref_frames) { + if (frame->paused()) { return true; } + } + return false; +} + +void +RTPPacket::set_paused(bool paused) +{ + std::for_each(_ref_frames.begin(), _ref_frames.end(), [paused](Frame::Ptr &frame) { frame->set_paused(paused); }); +} + +RTPPacket::RTPPacket(RTPManager *owner, Frame::Ptr udp_frame) + +{ + IncRTPPacketCnt(); + _owner = owner; + _ref_frames.push_back(udp_frame); + _frame_type = Frame::kUDP; + _rtp_ptr = udp_frame->data(); + _state = IsRTPHeader(udp_frame->data(), udp_frame->size()) ? kComplete : kError; + + udp_frame->set_paused(true); +} + +RTPPacket::RTPPacket(RTPManager *owner) : _owner(owner), _frame_type(Frame::kTCP) { IncRTPPacketCnt(); } + +}// namespace sign diff --git a/src/base/rtp_packet.h b/src/base/rtp_packet.h new file mode 100644 index 0000000..2eb8076 --- /dev/null +++ b/src/base/rtp_packet.h @@ -0,0 +1,67 @@ +#ifndef AW_SECURITY_MEDIA_LIB_BASE_RTP_H +#define AW_SECURITY_MEDIA_LIB_BASE_RTP_H + +#pragma once + +#include "base/frame.h" + +namespace sign { +class RTPManager; + +class RTPPacket : std::enable_shared_from_this { +public: + enum State { + kError = -1, + kMissTCPHeader = 0, + kMissRTPHeader = 1, + kMissPayload = 2, + kComplete = 3, + }; + + using Ptr = std::shared_ptr; + + static Ptr CreateParticalRTPPacket(RTPManager *owner); + static Ptr CreateCompleteRTPPacket(RTPManager *owner, Frame::Ptr udp_frame); + +public: + ~RTPPacket(); + + State state() const { return _state; } + + bool IsComplete() const { return state() == kComplete; } + + // available on kMissRTPHeader,kMissPayload,kComplete + size_t packet_size(); + const uint8_t *packet_data() const; + size_t rtp_payload_size(); + + // rtp header, kMissPayload or kComplete + uint8_t payload_type() const; + uint16_t seq() const; + uint32_t ssrc() const; + uint32_t timestamp() const; + + void set_seq(uint16_t seq); + + void AddRefFrame(Frame::Ptr frame); + + RTPManager *owner() const { return _owner; } + + bool paused() const; + void set_paused(bool paused); + +private: + RTPPacket(RTPManager *owner, Frame::Ptr udp_frame); + RTPPacket(RTPManager *owner); + +private: + RTPManager *_owner{nullptr}; + uint8_t *_rtp_ptr{nullptr}; + + Frame::Type _frame_type; + State _state; + std::vector _ref_frames; +}; +}// namespace sign + +#endif// AW_SECURITY_MEDIA_LIB_BASE_RTP_H diff --git a/src/base/signer.cpp b/src/base/signer.cpp new file mode 100644 index 0000000..7d277ae --- /dev/null +++ b/src/base/signer.cpp @@ -0,0 +1 @@ +#include "signer.h" diff --git a/src/base/signer.h b/src/base/signer.h new file mode 100644 index 0000000..b99ca71 --- /dev/null +++ b/src/base/signer.h @@ -0,0 +1,15 @@ +#ifndef AW_SECURITY_MEDIA_LIB_BASE_SIGNER_H +#define AW_SECURITY_MEDIA_LIB_BASE_SIGNER_H + +#pragma once + +#include +#include + +namespace sign { +class Signer { +public: +}; +}// namespace sign + +#endif// AW_SECURITY_MEDIA_LIB_BASE_SIGNER_H diff --git a/src/base/util.cpp b/src/base/util.cpp new file mode 100644 index 0000000..44fb903 --- /dev/null +++ b/src/base/util.cpp @@ -0,0 +1,110 @@ +#include "util.h" +extern "C" { +#include "SVAC/src/sm2sm3/sm2.h" +#include "SVAC/src/sm2sm3/sm3.h" +} + +namespace sign { +uint8_t +GetRTPVersion(const uint8_t *data) +{ + return (data[0] & 0xC0) >> 6; +} + +uint8_t +GetRTPPayloadType(const uint8_t *data) +{ + return data[1] & 0x7F; +} + +uint16_t +GetRTPSequenceNumber(const uint8_t *data) +{ + return (data[2] << 8) | data[3]; +} + +uint32_t +GetRTPTimestamp(const uint8_t *data) +{ + return (data[4] << 24) | (data[5] << 16) | (data[6] << 8) | data[7]; +} + +uint32_t +GetRTPSSRC(const uint8_t *header) +{ + return (header[8] << 24) | (header[9] << 16) | (header[10] << 8) | header[11]; +} + +void +SetRTPSequenceNumber(uint8_t *header, uint16_t seq) +{ + header[2] = seq >> 8; + header[3] = seq & 0xFF; +} + +bool +FindRTPOverTCPHeader(const uint8_t *data, size_t len, size_t *header_pos) +{ + if (len <= 0) { + return false; + } else if (len == 1) { + if (data[0] == '$') { + *header_pos = 0; + return true; + } else { + return false; + } + } else { + // len >= 2 + static const uint8_t kRTPOverTCPHeader[] = {'$', 0}; + uint8_t *ptr = (uint8_t *) memmem(data, len, kRTPOverTCPHeader, sizeof(kRTPOverTCPHeader)); + if (!ptr) { return false; } + *header_pos = ptr - data; + return true; + } +} + +bool +IsRTPHeader(const uint8_t *data, size_t len) +{ + if (len < 12) { return false; } + if (GetRTPVersion(data) != 2) { return false; } + return true; +} + +bool +IsParticalRTPHeader(const uint8_t *data, size_t len) +{ + if (len == 0) { + return true; + } else { + return GetRTPVersion(data) == 2; + } +} + +std::string +ToHex(const void *data, size_t len) +{ + static const char hex[] = "0123456789ABCDEF"; + std::string hex_str; + hex_str.resize(len * 2); + const uint8_t *ptr = (const uint8_t *) data; + for (size_t i = 0; i < len; i++) { + hex_str[2 * i] = hex[ptr[i] >> 4]; + hex_str[2 * i + 1] = hex[ptr[i] & 0x0F]; + } + return hex_str; +} + +std::vector +SM3Hash(const void *data, size_t len) +{ + uint8_t digest[128]; + sm3_ctx ctx; + sm3_init(&ctx); + sm3_update(&ctx, (const uint8_t *) data, len); + sm3_final(&ctx, digest); + return std::vector(digest, digest + 32); +} + +}// namespace sign diff --git a/src/base/util.h b/src/base/util.h new file mode 100644 index 0000000..28abbe4 --- /dev/null +++ b/src/base/util.h @@ -0,0 +1,30 @@ +#ifndef AW_SECURITY_MEDIA_LIB_BASE_UTIL_H +#define AW_SECURITY_MEDIA_LIB_BASE_UTIL_H + +#pragma once + +#include +#include +#include +#include + +namespace sign { +uint8_t GetRTPVersion(const uint8_t *header); +uint8_t GetRTPPayloadType(const uint8_t *header); +uint16_t GetRTPSequenceNumber(const uint8_t *header); +uint32_t GetRTPTimestamp(const uint8_t *header); +uint32_t GetRTPSSRC(const uint8_t *header); + +void SetRTPSequenceNumber(uint8_t *header, uint16_t seq); + +bool FindRTPOverTCPHeader(const uint8_t *data, size_t len, size_t *header_pos = nullptr); +bool IsRTPHeader(const uint8_t *data, size_t len); +bool IsParticalRTPHeader(const uint8_t *data, size_t len); + +std::string ToHex(const void *data, size_t len); + +std::vector SM3Hash(const void *data, size_t len); + +}// namespace sign + +#endif// AW_SECURITY_MEDIA_LIB_BASE_UTIL_H diff --git a/src/sigslot.h b/src/sigslot.h new file mode 100644 index 0000000..912b235 --- /dev/null +++ b/src/sigslot.h @@ -0,0 +1,1682 @@ +// sigslot.h: Signal/Slot classes +// +// Written by Sarah Thompson (sarah@telergy.com) 2002. +// +// License: Public domain. You are free to use this code however you like, with the proviso that +// the author takes on no responsibility or liability for any use. +// +// QUICK DOCUMENTATION +// +// (see also the full documentation at http://sigslot.sourceforge.net/) +// +// #define switches +// SIGSLOT_PURE_ISO - Define this to force ISO C++ compliance. This also disables +// all of the thread safety support on platforms where it is +// available. +// +// SIGSLOT_USE_POSIX_THREADS - Force use of Posix threads when using a C++ compiler other than +// gcc on a platform that supports Posix threads. (When using gcc, +// this is the default - use SIGSLOT_PURE_ISO to disable this if +// necessary) +// +// SIGSLOT_DEFAULT_MT_POLICY - Where thread support is enabled, this defaults to multi_threaded_global. +// Otherwise, the default is single_threaded. #define this yourself to +// override the default. In pure ISO mode, anything other than +// single_threaded will cause a compiler error. +// +// PLATFORM NOTES +// +// Win32 - On Win32, the WIN32 symbol must be #defined. Most mainstream +// compilers do this by default, but you may need to define it +// yourself if your build environment is less standard. This causes +// the Win32 thread support to be compiled in and used automatically. +// +// Unix/Linux/BSD, etc. - If you're using gcc, it is assumed that you have Posix threads +// available, so they are used automatically. You can override this +// (as under Windows) with the SIGSLOT_PURE_ISO switch. If you're using +// something other than gcc but still want to use Posix threads, you +// need to #define SIGSLOT_USE_POSIX_THREADS. +// +// ISO C++ - If none of the supported platforms are detected, or if +// SIGSLOT_PURE_ISO is defined, all multithreading support is turned off, +// along with any code that might cause a pure ISO C++ environment to +// complain. Before you ask, gcc -ansi -pedantic won't compile this +// library, but gcc -ansi is fine. Pedantic mode seems to throw a lot of +// errors that aren't really there. If you feel like investigating this, +// please contact the author. +// +// +// THREADING MODES +// +// single_threaded - Your program is assumed to be single threaded from the point of view +// of signal/slot usage (i.e. all objects using signals and slots are +// created and destroyed from a single thread). Behaviour if objects are +// destroyed concurrently is undefined (i.e. you'll get the occasional +// segmentation fault/memory exception). +// +// multi_threaded_global - Your program is assumed to be multi threaded. Objects using signals and +// slots can be safely created and destroyed from any thread, even when +// connections exist. In multi_threaded_global mode, this is achieved by a +// single global mutex (actually a critical section on Windows because they +// are faster). This option uses less OS resources, but results in more +// opportunities for contention, possibly resulting in more context switches +// than are strictly necessary. +// +// multi_threaded_local - Behaviour in this mode is essentially the same as multi_threaded_global, +// except that each signal, and each object that inherits has_slots, all +// have their own mutex/critical section. In practice, this means that +// mutex collisions (and hence context switches) only happen if they are +// absolutely essential. However, on some platforms, creating a lot of +// mutexes can slow down the whole OS, so use this option with care. +// +// USING THE LIBRARY +// +// See the full documentation at http://sigslot.sourceforge.net/ +// +// + +#ifndef __SIGSLOT_H__ +#define __SIGSLOT_H__ + +#include +#include + +#if defined(SIGSLOT_PURE_ISO) || (!defined(WIN32) && !defined(__GNUG__) && !defined(SIGSLOT_USE_POSIX_THREADS)) +# define _SIGSLOT_SINGLE_THREADED +#elif defined(WIN32) +# define _SIGSLOT_HAS_WIN32_THREADS +# include +#elif defined(__GNUG__) || defined(SIGSLOT_USE_POSIX_THREADS) +# define _SIGSLOT_HAS_POSIX_THREADS +# include +#else +# define _SIGSLOT_SINGLE_THREADED +#endif + +#ifndef SIGSLOT_DEFAULT_MT_POLICY +# ifdef _SIGSLOT_SINGLE_THREADED +# define SIGSLOT_DEFAULT_MT_POLICY single_threaded +# else +# define SIGSLOT_DEFAULT_MT_POLICY multi_threaded_local +# endif +#endif + +#ifndef SIGSLOT_EMIT +# ifdef QT_VERSION +# define SIGSLOT_EMIT broadcast +# else +# define SIGSLOT_EMIT emit +# endif +#endif + +namespace sigslot { + +class single_threaded +{ +public: + single_threaded() {} + virtual ~single_threaded() {} + virtual void lock() {} + virtual void unlock() {} +}; + +#ifdef _SIGSLOT_HAS_WIN32_THREADS +// The multi threading policies only get compiled in if they are enabled. +class multi_threaded_global +{ +public: + multi_threaded_global() + { + static bool isinitialised = false; + + if(!isinitialised) + { + InitializeCriticalSection(get_critsec()); + isinitialised = true; + } + } + + multi_threaded_global(const multi_threaded_global&) + {} + + virtual ~multi_threaded_global() + {} + + virtual void lock() + { + EnterCriticalSection(get_critsec()); + } + + virtual void unlock() + { + LeaveCriticalSection(get_critsec()); + } + +private: + CRITICAL_SECTION* get_critsec() + { + static CRITICAL_SECTION g_critsec; + return &g_critsec; + } +}; + +class multi_threaded_local +{ +public: + multi_threaded_local() + { + InitializeCriticalSection(&m_critsec); + } + + multi_threaded_local(const multi_threaded_local&) + { + InitializeCriticalSection(&m_critsec); + } + + virtual ~multi_threaded_local() + { + DeleteCriticalSection(&m_critsec); + } + + virtual void lock() + { + EnterCriticalSection(&m_critsec); + } + + virtual void unlock() + { + LeaveCriticalSection(&m_critsec); + } + +private: + CRITICAL_SECTION m_critsec; +}; +#endif // _SIGSLOT_HAS_WIN32_THREADS + +#ifdef _SIGSLOT_HAS_POSIX_THREADS +// The multi threading policies only get compiled in if they are enabled. +class multi_threaded_global +{ +public: + multi_threaded_global() + { + pthread_mutex_init(get_mutex(), NULL); + } + + multi_threaded_global(const multi_threaded_global&) + {} + + virtual ~multi_threaded_global() + {} + + virtual void lock() + { + pthread_mutex_lock(get_mutex()); + } + + virtual void unlock() + { + pthread_mutex_unlock(get_mutex()); + } + +private: + pthread_mutex_t* get_mutex() + { + static pthread_mutex_t g_mutex; + return &g_mutex; + } +}; + +class multi_threaded_local +{ +public: + multi_threaded_local() + { + pthread_mutex_init(&m_mutex, NULL); + } + + multi_threaded_local(const multi_threaded_local&) + { + pthread_mutex_init(&m_mutex, NULL); + } + + virtual ~multi_threaded_local() + { + pthread_mutex_destroy(&m_mutex); + } + + virtual void lock() + { + pthread_mutex_lock(&m_mutex); + } + + virtual void unlock() + { + pthread_mutex_unlock(&m_mutex); + } + +private: + pthread_mutex_t m_mutex; +}; +#endif // _SIGSLOT_HAS_POSIX_THREADS + +template +class lock_block +{ +public: + mt_policy *m_mutex; + + lock_block(mt_policy *mtx) + : m_mutex(mtx) + { + m_mutex->lock(); + } + + ~lock_block() + { + m_mutex->unlock(); + } +}; + +template +class has_slots; + +template +class _connection_base0 +{ +public: + virtual ~_connection_base0() {} + virtual has_slots* getdest() const = 0; + virtual void SIGSLOT_EMIT() = 0; + virtual _connection_base0* clone() = 0; + virtual _connection_base0* duplicate(has_slots* pnewdest) = 0; +}; + +template +class _connection_base1 +{ +public: + virtual ~_connection_base1() {} + virtual has_slots* getdest() const = 0; + virtual void SIGSLOT_EMIT(arg1_type) = 0; + virtual _connection_base1* clone() = 0; + virtual _connection_base1* duplicate(has_slots* pnewdest) = 0; +}; + +template +class _connection_base2 +{ +public: + virtual ~_connection_base2() {} + virtual has_slots* getdest() const = 0; + virtual void SIGSLOT_EMIT(arg1_type, arg2_type) = 0; + virtual _connection_base2* clone() = 0; + virtual _connection_base2* duplicate(has_slots* pnewdest) = 0; +}; + +template +class _connection_base3 +{ +public: + virtual ~_connection_base3() {} + virtual has_slots* getdest() const = 0; + virtual void SIGSLOT_EMIT(arg1_type, arg2_type, arg3_type) = 0; + virtual _connection_base3* clone() = 0; + virtual _connection_base3* duplicate(has_slots* pnewdest) = 0; +}; + +template +class _connection_base4 +{ +public: + virtual ~_connection_base4() {} + virtual has_slots* getdest() const = 0; + virtual void SIGSLOT_EMIT(arg1_type, arg2_type, arg3_type, arg4_type) = 0; + virtual _connection_base4* clone() = 0; + virtual _connection_base4* duplicate(has_slots* pnewdest) = 0; +}; + +template +class _connection_base5 +{ +public: + virtual ~_connection_base5() {} + virtual has_slots* getdest() const = 0; + virtual void SIGSLOT_EMIT(arg1_type, arg2_type, arg3_type, arg4_type, + arg5_type) = 0; + virtual _connection_base5* clone() = 0; + virtual _connection_base5* duplicate(has_slots* pnewdest) = 0; +}; + +template +class _connection_base6 +{ +public: + virtual ~_connection_base6() {} + virtual has_slots* getdest() const = 0; + virtual void SIGSLOT_EMIT(arg1_type, arg2_type, arg3_type, arg4_type, arg5_type, + arg6_type) = 0; + virtual _connection_base6* clone() = 0; + virtual _connection_base6* duplicate(has_slots* pnewdest) = 0; +}; + +template +class _connection_base7 +{ +public: + virtual ~_connection_base7() {} + virtual has_slots* getdest() const = 0; + virtual void SIGSLOT_EMIT(arg1_type, arg2_type, arg3_type, arg4_type, arg5_type, + arg6_type, arg7_type) = 0; + virtual _connection_base7* clone() = 0; + virtual _connection_base7* duplicate(has_slots* pnewdest) = 0; +}; + +template +class _connection_base8 +{ +public: + virtual ~_connection_base8() {} + virtual has_slots* getdest() const = 0; + virtual void SIGSLOT_EMIT(arg1_type, arg2_type, arg3_type, arg4_type, arg5_type, + arg6_type, arg7_type, arg8_type) = 0; + virtual _connection_base8* clone() = 0; + virtual _connection_base8* duplicate(has_slots* pnewdest) = 0; +}; + +template +class _signal_base : public mt_policy +{ +public: + virtual void slot_disconnect(has_slots* pslot) = 0; + virtual void slot_duplicate(const has_slots* poldslot, has_slots* pnewslot) = 0; +}; + +// Implements common functionality of signalN classes. signalN classes +// derive from this class. +template +class _signal_base_middle: public _signal_base +{ +public: + + typedef T connections_list; + typedef typename connections_list::iterator iterator; + typedef typename connections_list::const_iterator const_iterator; + + _signal_base_middle() {} + + _signal_base_middle(const _signal_base_middle &s) + : _signal_base(s) + { + lock_block lock(this); + + const_iterator it = s.m_connected_slots.begin(); + const_iterator itEnd = s.m_connected_slots.end(); + + while(it != itEnd) + { + (*it)->getdest()->signal_connect(this); + m_connected_slots.push_back((*it)->clone()); + ++it; + } + } + + virtual ~_signal_base_middle() {} + + void disconnect_all() + { + lock_block lock(this); + + const_iterator it = m_connected_slots.begin(); + const_iterator itEnd = m_connected_slots.end(); + + while(it != itEnd) + { + (*it)->getdest()->signal_disconnect(this); + delete *it; + + ++it; + } + + m_connected_slots.erase(m_connected_slots.begin(), m_connected_slots.end()); + } + + bool is_empty() + { + lock_block lock(this); + + const_iterator it = m_connected_slots.begin(); + const_iterator itEnd = m_connected_slots.end(); + + return it == itEnd; + } + +#ifdef _DEBUG + bool connected(has_slots* pclass) + { + lock_block lock(this); + + const_iterator itNext, it = m_connected_slots.begin(); + const_iterator itEnd = m_connected_slots.end(); + + while(it != itEnd) + { + itNext = it; + ++itNext; + if ((*it)->getdest() == pclass) + return true; + it = itNext; + } + return false; + } +#endif + + void disconnect(has_slots* pclass) + { + lock_block lock(this); + + iterator it = m_connected_slots.begin(); + iterator itEnd = m_connected_slots.end(); + + while(it != itEnd) + { + if((*it)->getdest() == pclass) + { + delete *it; + m_connected_slots.erase(it); + pclass->signal_disconnect(this); + return; + } + + ++it; + } + } + + void slot_disconnect(has_slots* pslot) + { + lock_block lock(this); + + iterator it = m_connected_slots.begin(); + iterator itEnd = m_connected_slots.end(); + + while(it != itEnd) + { + iterator itNext = it; + ++itNext; + + if((*it)->getdest() == pslot) + { + delete *it; + m_connected_slots.erase(it); + } + + it = itNext; + } + } + + void slot_duplicate(const has_slots* oldtarget, has_slots* newtarget) + { + lock_block lock(this); + + iterator it = m_connected_slots.begin(); + iterator itEnd = m_connected_slots.end(); + + while(it != itEnd) + { + if((*it)->getdest() == oldtarget) + { + m_connected_slots.push_back((*it)->duplicate(newtarget)); + } + + ++it; + } + } + +protected: + + connections_list m_connected_slots; + +}; + +template +class has_slots : public mt_policy +{ +private: + typedef typename std::set<_signal_base *> sender_set; + typedef typename sender_set::const_iterator const_iterator; + +public: + has_slots() + {} + + has_slots(const has_slots& hs) + : mt_policy(hs) + { + lock_block lock(this); + const_iterator it = hs.m_senders.begin(); + const_iterator itEnd = hs.m_senders.end(); + + while(it != itEnd) + { + (*it)->slot_duplicate(&hs, this); + m_senders.insert(*it); + ++it; + } + } + + void signal_connect(_signal_base* sender) + { + lock_block lock(this); + m_senders.insert(sender); + } + + void signal_disconnect(_signal_base* sender) + { + lock_block lock(this); + m_senders.erase(sender); + } + + virtual ~has_slots() + { + disconnect_all(); + } + + void disconnect_all() + { + lock_block lock(this); + const_iterator it = m_senders.begin(); + const_iterator itEnd = m_senders.end(); + + while(it != itEnd) + { + (*it)->slot_disconnect(this); + ++it; + } + + m_senders.erase(m_senders.begin(), m_senders.end()); + } + +private: + sender_set m_senders; +}; + + + +template +class _connection0 : public _connection_base0 +{ +public: + _connection0() + { + m_pobject = NULL; + m_pmemfun = NULL; + } + + _connection0(dest_type* pobject, void (dest_type::*pmemfun)()) + { + m_pobject = pobject; + m_pmemfun = pmemfun; + } + + virtual ~_connection0() + {} + + virtual _connection_base0* clone() + { + return new _connection0(*this); + } + + virtual _connection_base0* duplicate(has_slots* pnewdest) + { + return new _connection0((dest_type *)pnewdest, m_pmemfun); + } + + virtual void SIGSLOT_EMIT() + { + (m_pobject->*m_pmemfun)(); + } + + virtual has_slots* getdest() const + { + return m_pobject; + } + +private: + dest_type* m_pobject; + void (dest_type::* m_pmemfun)(); +}; + +template +class _connection1 : public _connection_base1 +{ +public: + _connection1() + { + m_pobject = NULL; + m_pmemfun = NULL; + } + + _connection1(dest_type* pobject, void (dest_type::*pmemfun)(arg1_type)) + { + m_pobject = pobject; + m_pmemfun = pmemfun; + } + + virtual ~_connection1() + {} + + virtual _connection_base1* clone() + { + return new _connection1(*this); + } + + virtual _connection_base1* duplicate(has_slots* pnewdest) + { + return new _connection1((dest_type *)pnewdest, m_pmemfun); + } + + virtual void SIGSLOT_EMIT(arg1_type a1) + { + (m_pobject->*m_pmemfun)(a1); + } + + virtual has_slots* getdest() const + { + return m_pobject; + } + +private: + dest_type* m_pobject; + void (dest_type::* m_pmemfun)(arg1_type); +}; + +template +class _connection2 : public _connection_base2 +{ +public: + _connection2() + { + m_pobject = NULL; + m_pmemfun = NULL; + } + + _connection2(dest_type* pobject, void (dest_type::*pmemfun)(arg1_type, + arg2_type)) + { + m_pobject = pobject; + m_pmemfun = pmemfun; + } + + virtual ~_connection2() + {} + + virtual _connection_base2* clone() + { + return new _connection2(*this); + } + + virtual _connection_base2* duplicate(has_slots* pnewdest) + { + return new _connection2((dest_type *)pnewdest, m_pmemfun); + } + + virtual void SIGSLOT_EMIT(arg1_type a1, arg2_type a2) + { + (m_pobject->*m_pmemfun)(a1, a2); + } + + virtual has_slots* getdest() const + { + return m_pobject; + } + +private: + dest_type* m_pobject; + void (dest_type::* m_pmemfun)(arg1_type, arg2_type); +}; + +template +class _connection3 : public _connection_base3 +{ +public: + _connection3() + { + m_pobject = NULL; + m_pmemfun = NULL; + } + + _connection3(dest_type* pobject, void (dest_type::*pmemfun)(arg1_type, + arg2_type, arg3_type)) + { + m_pobject = pobject; + m_pmemfun = pmemfun; + } + + virtual ~_connection3() + {} + + virtual _connection_base3* clone() + { + return new _connection3(*this); + } + + virtual _connection_base3* duplicate(has_slots* pnewdest) + { + return new _connection3((dest_type *)pnewdest, m_pmemfun); + } + + virtual void SIGSLOT_EMIT(arg1_type a1, arg2_type a2, arg3_type a3) + { + (m_pobject->*m_pmemfun)(a1, a2, a3); + } + + virtual has_slots* getdest() const + { + return m_pobject; + } + +private: + dest_type* m_pobject; + void (dest_type::* m_pmemfun)(arg1_type, arg2_type, arg3_type); +}; + +template +class _connection4 : public _connection_base4 +{ +public: + _connection4() + { + m_pobject = NULL; + m_pmemfun = NULL; + } + + _connection4(dest_type* pobject, void (dest_type::*pmemfun)(arg1_type, + arg2_type, arg3_type, arg4_type)) + { + m_pobject = pobject; + m_pmemfun = pmemfun; + } + + virtual ~_connection4() + {} + + virtual _connection_base4* clone() + { + return new _connection4(*this); + } + + virtual _connection_base4* duplicate(has_slots* pnewdest) + { + return new _connection4((dest_type *)pnewdest, m_pmemfun); + } + + virtual void SIGSLOT_EMIT(arg1_type a1, arg2_type a2, arg3_type a3, + arg4_type a4) + { + (m_pobject->*m_pmemfun)(a1, a2, a3, a4); + } + + virtual has_slots* getdest() const + { + return m_pobject; + } + +private: + dest_type* m_pobject; + void (dest_type::* m_pmemfun)(arg1_type, arg2_type, arg3_type, + arg4_type); +}; + +template +class _connection5 : public _connection_base5 +{ +public: + _connection5() + { + m_pobject = NULL; + m_pmemfun = NULL; + } + + _connection5(dest_type* pobject, void (dest_type::*pmemfun)(arg1_type, + arg2_type, arg3_type, arg4_type, arg5_type)) + { + m_pobject = pobject; + m_pmemfun = pmemfun; + } + + virtual ~_connection5() + {} + + virtual _connection_base5* clone() + { + return new _connection5(*this); + } + + virtual _connection_base5* duplicate(has_slots* pnewdest) + { + return new _connection5((dest_type *)pnewdest, m_pmemfun); + } + + virtual void SIGSLOT_EMIT(arg1_type a1, arg2_type a2, arg3_type a3, arg4_type a4, + arg5_type a5) + { + (m_pobject->*m_pmemfun)(a1, a2, a3, a4, a5); + } + + virtual has_slots* getdest() const + { + return m_pobject; + } + +private: + dest_type* m_pobject; + void (dest_type::* m_pmemfun)(arg1_type, arg2_type, arg3_type, arg4_type, + arg5_type); +}; + +template +class _connection6 : public _connection_base6 +{ +public: + _connection6() + { + m_pobject = NULL; + m_pmemfun = NULL; + } + + _connection6(dest_type* pobject, void (dest_type::*pmemfun)(arg1_type, + arg2_type, arg3_type, arg4_type, arg5_type, arg6_type)) + { + m_pobject = pobject; + m_pmemfun = pmemfun; + } + + virtual ~_connection6() + {} + + virtual _connection_base6* clone() + { + return new _connection6(*this); + } + + virtual _connection_base6* duplicate(has_slots* pnewdest) + { + return new _connection6((dest_type *)pnewdest, m_pmemfun); + } + + virtual void SIGSLOT_EMIT(arg1_type a1, arg2_type a2, arg3_type a3, arg4_type a4, + arg5_type a5, arg6_type a6) + { + (m_pobject->*m_pmemfun)(a1, a2, a3, a4, a5, a6); + } + + virtual has_slots* getdest() const + { + return m_pobject; + } + +private: + dest_type* m_pobject; + void (dest_type::* m_pmemfun)(arg1_type, arg2_type, arg3_type, arg4_type, + arg5_type, arg6_type); +}; + +template +class _connection7 : public _connection_base7 +{ +public: + _connection7() + { + m_pobject = NULL; + m_pmemfun = NULL; + } + + _connection7(dest_type* pobject, void (dest_type::*pmemfun)(arg1_type, + arg2_type, arg3_type, arg4_type, arg5_type, arg6_type, arg7_type)) + { + m_pobject = pobject; + m_pmemfun = pmemfun; + } + + virtual ~_connection7() + {} + + virtual _connection_base7* clone() + { + return new _connection7(*this); + } + + virtual _connection_base7* duplicate(has_slots* pnewdest) + { + return new _connection7((dest_type *)pnewdest, m_pmemfun); + } + + virtual void SIGSLOT_EMIT(arg1_type a1, arg2_type a2, arg3_type a3, arg4_type a4, + arg5_type a5, arg6_type a6, arg7_type a7) + { + (m_pobject->*m_pmemfun)(a1, a2, a3, a4, a5, a6, a7); + } + + virtual has_slots* getdest() const + { + return m_pobject; + } + +private: + dest_type* m_pobject; + void (dest_type::* m_pmemfun)(arg1_type, arg2_type, arg3_type, arg4_type, + arg5_type, arg6_type, arg7_type); +}; + +template +class _connection8 : public _connection_base8 +{ +public: + _connection8() + { + m_pobject = NULL; + m_pmemfun = NULL; + } + + _connection8(dest_type* pobject, void (dest_type::*pmemfun)(arg1_type, + arg2_type, arg3_type, arg4_type, arg5_type, arg6_type, + arg7_type, arg8_type)) + { + m_pobject = pobject; + m_pmemfun = pmemfun; + } + + virtual ~_connection8() + {} + + virtual _connection_base8* clone() + { + return new _connection8(*this); + } + + virtual _connection_base8* duplicate(has_slots* pnewdest) + { + return new _connection8((dest_type *)pnewdest, m_pmemfun); + } + + virtual void SIGSLOT_EMIT(arg1_type a1, arg2_type a2, arg3_type a3, arg4_type a4, + arg5_type a5, arg6_type a6, arg7_type a7, arg8_type a8) + { + (m_pobject->*m_pmemfun)(a1, a2, a3, a4, a5, a6, a7, a8); + } + + virtual has_slots* getdest() const + { + return m_pobject; + } + +private: + dest_type* m_pobject; + void (dest_type::* m_pmemfun)(arg1_type, arg2_type, arg3_type, arg4_type, + arg5_type, arg6_type, arg7_type, arg8_type); +}; + +template +class signal0 : public _signal_base_middle*>, mt_policy> +{ +public: + + typedef signal0 this_type; + typedef std::list<_connection_base0*> connections_list; + typedef _signal_base_middle base_type; + + using base_type::m_connected_slots; + + signal0() + {} + + signal0(const this_type& s) + : base_type(s) + {} + + ~signal0() + { + base_type::disconnect_all(); + } + + template + void connect(desttype* pclass, void (desttype::*pmemfun)()) + { + lock_block lock(this); + + _connection0* conn = + new _connection0(pclass, pmemfun); + + m_connected_slots.push_back(conn); + pclass->signal_connect(this); + } + + void SIGSLOT_EMIT() + { + lock_block lock(this); + + typename connections_list::const_iterator itNext, it = m_connected_slots.begin(); + typename connections_list::const_iterator itEnd = m_connected_slots.end(); + + while(it != itEnd) + { + itNext = it; + ++itNext; + + (*it)->SIGSLOT_EMIT(); + + it = itNext; + } + } + + void operator()() + { + SIGSLOT_EMIT(); + } +}; + +template +class signal1 : public _signal_base_middle*>, mt_policy> +{ +public: + + typedef signal1 this_type; + typedef std::list<_connection_base1*> connections_list; + typedef _signal_base_middle base_type; + + using base_type::m_connected_slots; + + signal1() + {} + + signal1(const this_type& s) + : base_type(s) + {} + + ~signal1() + { + base_type::disconnect_all(); + } + + template + void connect(desttype* pclass, void (desttype::*pmemfun)(arg1_type)) + { + lock_block lock(this); + _connection1* conn = + new _connection1(pclass, pmemfun); + m_connected_slots.push_back(conn); + pclass->signal_connect(this); + } + + void SIGSLOT_EMIT(arg1_type a1) + { + lock_block lock(this); + typename connections_list::const_iterator itNext, it = m_connected_slots.begin(); + typename connections_list::const_iterator itEnd = m_connected_slots.end(); + + while(it != itEnd) + { + itNext = it; + ++itNext; + + (*it)->SIGSLOT_EMIT(a1); + + it = itNext; + } + } + + void operator()(arg1_type a1) + { + SIGSLOT_EMIT(a1); + } +}; + +template +class signal2 : public _signal_base_middle*>, mt_policy> +{ +public: + + typedef signal2 this_type; + typedef std::list<_connection_base2*> connections_list; + typedef _signal_base_middle base_type; + + using base_type::m_connected_slots; + + signal2() + {} + + signal2(const this_type& s) + : base_type(s) + {} + + ~signal2() + { + base_type::disconnect_all(); + } + + template + void connect(desttype* pclass, void (desttype::*pmemfun)(arg1_type, + arg2_type)) + { + lock_block lock(this); + _connection2* conn = new + _connection2(pclass, pmemfun); + m_connected_slots.push_back(conn); + pclass->signal_connect(this); + } + + void SIGSLOT_EMIT(arg1_type a1, arg2_type a2) + { + lock_block lock(this); + typename connections_list::const_iterator itNext, it = m_connected_slots.begin(); + typename connections_list::const_iterator itEnd = m_connected_slots.end(); + + while(it != itEnd) + { + itNext = it; + ++itNext; + + (*it)->SIGSLOT_EMIT(a1, a2); + + it = itNext; + } + } + + void operator()(arg1_type a1, arg2_type a2) + { + SIGSLOT_EMIT(a1, a2); + } +}; + +template +class signal3 : public _signal_base_middle*>, mt_policy> +{ +public: + + typedef signal3 this_type; + typedef std::list<_connection_base3*> connections_list; + typedef _signal_base_middle base_type; + + using base_type::m_connected_slots; + + signal3() + {} + + signal3(const this_type& s) + : base_type(s) + {} + + ~signal3() + { + base_type::disconnect_all(); + } + + template + void connect(desttype* pclass, void (desttype::*pmemfun)(arg1_type, + arg2_type, arg3_type)) + { + lock_block lock(this); + _connection3* conn = + new _connection3(pclass, + pmemfun); + m_connected_slots.push_back(conn); + pclass->signal_connect(this); + } + + void SIGSLOT_EMIT(arg1_type a1, arg2_type a2, arg3_type a3) + { + lock_block lock(this); + typename connections_list::const_iterator itNext, it = m_connected_slots.begin(); + typename connections_list::const_iterator itEnd = m_connected_slots.end(); + + while(it != itEnd) + { + itNext = it; + ++itNext; + + (*it)->SIGSLOT_EMIT(a1, a2, a3); + + it = itNext; + } + } + + void operator()(arg1_type a1, arg2_type a2, arg3_type a3) + { + SIGSLOT_EMIT(a1, a2, a3); + } +}; + +template +class signal4 : public _signal_base_middle*>, mt_policy> +{ +public: + + typedef signal4 this_type; + typedef std::list<_connection_base4*> connections_list; + typedef _signal_base_middle base_type; + + using base_type::m_connected_slots; + + signal4() + {} + + signal4(const this_type& s) + : base_type(s) + {} + + ~signal4() + { + base_type::disconnect_all(); + } + + template + void connect(desttype* pclass, void (desttype::*pmemfun)(arg1_type, + arg2_type, arg3_type, arg4_type)) + { + lock_block lock(this); + _connection4* + conn = new _connection4(pclass, pmemfun); + m_connected_slots.push_back(conn); + pclass->signal_connect(this); + } + + void SIGSLOT_EMIT(arg1_type a1, arg2_type a2, arg3_type a3, arg4_type a4) + { + lock_block lock(this); + typename connections_list::const_iterator itNext, it = m_connected_slots.begin(); + typename connections_list::const_iterator itEnd = m_connected_slots.end(); + + while(it != itEnd) + { + itNext = it; + ++itNext; + + (*it)->SIGSLOT_EMIT(a1, a2, a3, a4); + + it = itNext; + } + } + + void operator()(arg1_type a1, arg2_type a2, arg3_type a3, arg4_type a4) + { + SIGSLOT_EMIT(a1, a2, a3, a4); + } +}; + +template +class signal5 : public _signal_base_middle*>, mt_policy> +{ +public: + + typedef signal5 this_type; + typedef std::list<_connection_base5*> connections_list; + typedef _signal_base_middle base_type; + + using base_type::m_connected_slots; + + signal5() + {} + + signal5(const this_type& s) + : base_type(s) + {} + + ~signal5() + { + base_type::disconnect_all(); + } + + template + void connect(desttype* pclass, void (desttype::*pmemfun)(arg1_type, + arg2_type, arg3_type, arg4_type, arg5_type)) + { + lock_block lock(this); + _connection5* conn = new _connection5(pclass, pmemfun); + m_connected_slots.push_back(conn); + pclass->signal_connect(this); + } + + void SIGSLOT_EMIT(arg1_type a1, arg2_type a2, arg3_type a3, arg4_type a4, + arg5_type a5) + { + lock_block lock(this); + typename connections_list::const_iterator itNext, it = m_connected_slots.begin(); + typename connections_list::const_iterator itEnd = m_connected_slots.end(); + + while(it != itEnd) + { + itNext = it; + ++itNext; + + (*it)->SIGSLOT_EMIT(a1, a2, a3, a4, a5); + + it = itNext; + } + } + + void operator()(arg1_type a1, arg2_type a2, arg3_type a3, arg4_type a4, + arg5_type a5) + { + SIGSLOT_EMIT(a1, a2, a3, a4, a5); + } +}; + + +template +class signal6 : public _signal_base_middle*>, mt_policy> +{ +public: + + typedef signal6 this_type; + typedef std::list<_connection_base6*> connections_list; + typedef _signal_base_middle base_type; + + using base_type::m_connected_slots; + + signal6() + {} + + signal6(const this_type& s) + : base_type(s) + {} + + ~signal6() + { + base_type::disconnect_all(); + } + + template + void connect(desttype* pclass, void (desttype::*pmemfun)(arg1_type, + arg2_type, arg3_type, arg4_type, arg5_type, arg6_type)) + { + lock_block lock(this); + _connection6* conn = + new _connection6(pclass, pmemfun); + m_connected_slots.push_back(conn); + pclass->signal_connect(this); + } + + void SIGSLOT_EMIT(arg1_type a1, arg2_type a2, arg3_type a3, arg4_type a4, + arg5_type a5, arg6_type a6) + { + lock_block lock(this); + typename connections_list::const_iterator itNext, it = m_connected_slots.begin(); + typename connections_list::const_iterator itEnd = m_connected_slots.end(); + + while(it != itEnd) + { + itNext = it; + ++itNext; + + (*it)->SIGSLOT_EMIT(a1, a2, a3, a4, a5, a6); + + it = itNext; + } + } + + void operator()(arg1_type a1, arg2_type a2, arg3_type a3, arg4_type a4, + arg5_type a5, arg6_type a6) + { + SIGSLOT_EMIT(a1, a2, a3, a4, a5, a6); + } +}; + +template +class signal7 : public _signal_base_middle*>, mt_policy> +{ +public: + + typedef signal7 this_type; + typedef std::list<_connection_base7*> connections_list; + typedef _signal_base_middle base_type; + + using base_type::m_connected_slots; + + signal7() + {} + + signal7(const this_type& s) + : base_type(s) + {} + + ~signal7() + { + base_type::disconnect_all(); + } + + template + void connect(desttype* pclass, void (desttype::*pmemfun)(arg1_type, + arg2_type, arg3_type, arg4_type, arg5_type, arg6_type, + arg7_type)) + { + lock_block lock(this); + _connection7* conn = + new _connection7(pclass, pmemfun); + m_connected_slots.push_back(conn); + pclass->signal_connect(this); + } + + void SIGSLOT_EMIT(arg1_type a1, arg2_type a2, arg3_type a3, arg4_type a4, + arg5_type a5, arg6_type a6, arg7_type a7) + { + lock_block lock(this); + typename connections_list::const_iterator itNext, it = m_connected_slots.begin(); + typename connections_list::const_iterator itEnd = m_connected_slots.end(); + + while(it != itEnd) + { + itNext = it; + ++itNext; + + (*it)->SIGSLOT_EMIT(a1, a2, a3, a4, a5, a6, a7); + + it = itNext; + } + } + + void operator()(arg1_type a1, arg2_type a2, arg3_type a3, arg4_type a4, + arg5_type a5, arg6_type a6, arg7_type a7) + { + SIGSLOT_EMIT(a1, a2, a3, a4, a5, a6, a7); + } +}; + +template +class signal8 : public _signal_base_middle*>, mt_policy> +{ +public: + + typedef signal8 this_type; + typedef std::list<_connection_base8*> connections_list; + typedef _signal_base_middle base_type; + + using base_type::m_connected_slots; + + signal8() + {} + + signal8(const this_type& s) + : base_type(s) + {} + + ~signal8() + { + base_type::disconnect_all(); + } + + template + void connect(desttype* pclass, void (desttype::*pmemfun)(arg1_type, + arg2_type, arg3_type, arg4_type, arg5_type, arg6_type, + arg7_type, arg8_type)) + { + lock_block lock(this); + _connection8* conn = + new _connection8(pclass, pmemfun); + m_connected_slots.push_back(conn); + pclass->signal_connect(this); + } + + void SIGSLOT_EMIT(arg1_type a1, arg2_type a2, arg3_type a3, arg4_type a4, + arg5_type a5, arg6_type a6, arg7_type a7, arg8_type a8) + { + lock_block lock(this); + typename connections_list::const_iterator itNext, it = m_connected_slots.begin(); + typename connections_list::const_iterator itEnd = m_connected_slots.end(); + + while(it != itEnd) + { + itNext = it; + ++itNext; + + (*it)->SIGSLOT_EMIT(a1, a2, a3, a4, a5, a6, a7, a8); + + it = itNext; + } + } + + void operator()(arg1_type a1, arg2_type a2, arg3_type a3, arg4_type a4, + arg5_type a5, arg6_type a6, arg7_type a7, arg8_type a8) + { + SIGSLOT_EMIT(a1, a2, a3, a4, a5, a6, a7, a8); + } +}; + +namespace impl +{ + +struct empty {}; + +} // namespace impl + +// signal can be used instead of the numbered signalN classes. +// For example: +// +// sigslot::signal signal; +// +// instead of +// +// sigslot::signal2 signal; +template +struct signal; + +template<> +struct signal<>: public signal0<> +{}; + +template +struct signal: public signal1 +{}; + +template +struct signal: public signal2 +{}; + +template +struct signal: public signal3 +{}; + +template +struct signal: public signal4 +{}; + +template +struct signal: public signal5 +{}; + +template +struct signal: public signal6 +{}; + +template +struct signal: + public signal7 +{}; + +template +struct signal: public signal8 +{}; + +// Some convenience methods for signal handling. +template +struct has_signals +{ + virtual ~has_signals() {} + + // Connect a signal to a slot on the specified destination object. + template + static inline void connect(Signal &signal, Dst *dst, Sig memfun) + { + signal.connect(dst, memfun); + } + + // Connect a signal to a slot on 'this'. + template + inline void connect(Signal &signal, Sig memfun) + { + Derived* dst = static_cast(this); + connect(signal, dst, memfun); + } +}; + +}; // namespace sigslot + +#endif // __SIGSLOT_H__ \ No newline at end of file