97资源网总站人人超碰,日韩VA无码中文字幕不卡

#define uchar unsigned char
#define uint unsigned int
String comdata = "";
unsigned long addr;
int PTT = 10; //PTT控制端
int TX=9;//數(shù)據(jù)輸出端
int ys=819;//延時(shí)
unsigned long tem;
uchar Tx_Num;
unsigned long calc_bch_and_parity(unsigned long cw_e) //BCH校驗(yàn)和奇偶校驗(yàn)函數(shù)
{
uchar i;
uchar parity = 0; //奇偶校驗(yàn)計(jì)數(shù)
unsigned long local_cw; //臨時(shí)存放數(shù)
local_cw=cw_e;//保存cw_e參數(shù)值
for(i=1;i<=21; i++,cw_e<<=1)
if (cw_e & 0x80000000) cw_e ^= 0xED200000;
cw_e=cw_e&0xFFC00000;//保留前10位，BCH校驗(yàn)值共11位，只保留前10位有效數(shù)據(jù)
local_cw |= (cw_e >> 21); //BCH校驗(yàn)數(shù)移至第22位到31位，BCH共10位，并和原始數(shù)據(jù)相加
cw_e=local_cw;
for(i=0; i<31; i++, cw_e<<=1) if(cw_e&0x80000000) parity++;
if(parity%2) local_cw+=1;//從1至31位判斷為奇數(shù)則后面加1補(bǔ)充為偶數(shù)
return local_cw;
}
unsigned long calc_addr( unsigned long add,uchar fun ) //地址轉(zhuǎn)換，第1參數(shù)為地址，第2參數(shù)為功能
{
unsigned long adr;
unsigned long tem;
Tx_Num=(uchar)(add&0x00000007);//獲取地址發(fā)射的幀位次，111位第7幀，后3位地址數(shù)據(jù)隱藏不發(fā)送，接收按幀位還原
adr=0x00;
adr=add&0xFFFFFFF8; //去掉地址碼后3位
adr=adr<<10; //地址左移10位
tem=0x00;
tem=fun; //功能位
tem=tem<<11;//功能位左移11位，功能位為00 01 10 11四種狀態(tài)，代表4個(gè)地址碼
adr=adr|tem; //地址碼和功能位合成地址碼；
return adr;
}
void Send_start(unsigned long s)
{
uchar i,n;
unsigned long tem;
for(i=0; i<20; i++)//發(fā)送576個(gè)前導(dǎo)10101010101010
{
tem=s;
for (n=0; n<32; n++)
{
if(tem&0x80000000)
{
digitalWrite(TX,HIGH);
}
else
{
digitalWrite(TX,LOW);
}
delayMicroseconds(ys);//等待延時(shí)結(jié)束 0.833ms
tem<<=1;
}
}
}
void Send_nill()//發(fā)送閑置位
{
uchar n;
unsigned long s=0x7A89C197;
for(n=0; n<32; n++)
{
if(s&0x80000000)
{
digitalWrite(TX,LOW);
}
else
{
digitalWrite(TX,HIGH);
}
delayMicroseconds(ys);//等待延時(shí)結(jié)束 0.833ms
s<<=1;
}
}
void Send_Num(unsigned long s,char npi) //發(fā)送數(shù)據(jù)
{
uchar n;
int xx0,xx1;
if(npi=='P'){xx1=1;xx0=0;}
if(npi=='N'){xx1=0;xx0=1;}
for (n=0; n<32; n++)
{
if(s&0x80000000)
{
digitalWrite(TX,xx1);
//Serial.print(xx1);
}
else
{
digitalWrite(TX,xx0);
//Serial.print(xx0);
}
delayMicroseconds(ys);//等待延時(shí)結(jié)束 0.833ms
s<<=1;
}
}
void setup() {
Serial.begin(9600); //設(shè)置波特率為9600，一般是這個(gè)波特率
pinMode(TX,OUTPUT);
pinMode(PTT,OUTPUT);
}
void loop() {
while (Serial.available() > 0) //讀取串口數(shù)據(jù)
{
comdata += char(Serial.read());
delay(2);
}
if (comdata.length() > 0) //如果有數(shù)據(jù)進(jìn)入處理
{
String np = comdata.substring(0,1);
char npzf=toupper(np[0]);
String ly=comdata.substring(8,9);
int lyi=ly[0];
String dz = comdata.substring(1,8); //獲取地址碼
unsigned long az=dz.toInt(); //地址碼s轉(zhuǎn)類型
tem=calc_addr(az,lyi-48); //地址碼移位處理
addr=calc_bch_and_parity(tem); //地址碼BCH校驗(yàn)
String msgdata = comdata.substring(9,200); //截取信息碼內(nèi)容
int len = msgdata.length()+10; //獲取信息碼字節(jié)長(zhǎng)度(+4為了讓長(zhǎng)度大于1幀，就不用1個(gè)漢字還用做判斷了)
byte hui[200]={0};
digitalWrite(PTT,LOW); //對(duì)講機(jī)ppt
delay(500); //延時(shí)500ms
unsigned long mess[200]={0}; //信息碼數(shù)組
//信息碼數(shù)組元素
unsigned long msg;
int ll=0;
int wz=0;
if(!(msgdata[0]&0x80)){hui[wz]=0x0f;wz++;}
for(int i=0;i<len;i++)
{
if(!(msgdata[i]&0x80) && msgdata[i-1]&0x80 && i>0){hui[wz]=0x0f;wz++;}
hui[wz]=msgdata[i];
wz++;
if(!(msgdata[i]&0x80) && msgdata[i+1]&0x80){hui[wz]=0x0e;wz++;}
}
wz=0;
int k=1;
for(int n=0;n<=len;n++)
{
for(int j=0;j<7;j++)
{
if(hui[wz]&0x01){msg|=0x00000001;}
msg<<=1;
hui[wz]>>=1;
ll++;
if(ll%20==0)
{
msg<<=10;
msg|=0x80000000;
mess[k]=calc_bch_and_parity(msg);
msg=0;
k++;
}
}
wz++;
}
Send_start(0xAAAAAAAA); //發(fā)送前言碼
Send_Num(0x7CD215D8,npzf); //發(fā)送同步碼
mess[0]=addr; //地址碼放入信息碼第一碼字
for(int j=0;j<120;j++) //循環(huán)發(fā)送信息碼
{
if(mess[j]!=0){Send_Num(mess[j],npzf);} //數(shù)組元素不為0的發(fā)送
Serial.println(mess[j],BIN);
if((j+1)%16==0 && j!=0){Send_Num(0x7CD215D8,npzf);} //每隔8幀發(fā)送一個(gè)同步碼
}
Send_Num(0x7A89C197,npzf); //末尾發(fā)送閑置碼
comdata="";
msgdata="";
}
digitalWrite(PTT,HIGH);
}

復(fù)制代碼