Compare commits
2
Commits
suzhou
..
96d1d60145
| Author | SHA1 | Date | |
|---|---|---|---|
 xu
|
96d1d60145 | ||
|
xu
|
988251e5aa |
@@ -1,7 +1,8 @@
|
||||
{
|
||||
"permissions": {
|
||||
"allow": [
|
||||
"Read(//c/Windows/Fonts//**)"
|
||||
"Read(//c/Windows/Fonts//**)",
|
||||
"Read(//z/work/**)"
|
||||
],
|
||||
"deny": [
|
||||
"Edit",
|
||||
|
||||
@@ -470,7 +470,6 @@ void vo_chn_switch(int vo_channel , int priority, int mux ){
|
||||
return;
|
||||
}
|
||||
|
||||
#if 0
|
||||
if (mux == 1) {
|
||||
/* 双屏窗口 960x720：chn0 在左，chn1 在右 */
|
||||
chn_attr.rect.x = (vo_channel == 0) ? 0 : 960;
|
||||
@@ -492,29 +491,6 @@ void vo_chn_switch(int vo_channel , int priority, int mux ){
|
||||
chn_attr.rect.width = 1280;
|
||||
chn_attr.rect.height = 720;
|
||||
}
|
||||
#endif
|
||||
if (mux == 1) {
|
||||
/* 双屏 960x720：180° 后 chn0 右下、chn1 左下 */
|
||||
chn_attr.rect.x = (vo_channel == 0) ? 960 : 0;
|
||||
chn_attr.rect.y = 480; /* 1200 - 720 */
|
||||
chn_attr.rect.width = 960;
|
||||
chn_attr.rect.height = 720;
|
||||
|
||||
} else if (mux == 0) {
|
||||
/* 全屏 1920x1200：中心对称后仍为整屏，位置不动 */
|
||||
chn_attr.rect.x = 0;
|
||||
chn_attr.rect.y = 0;
|
||||
chn_attr.rect.width = 1920;
|
||||
chn_attr.rect.height = 1200;
|
||||
|
||||
} else if (mux == 2) {
|
||||
/* 原右上角 1280x720 → 180° 后落到左下角 */
|
||||
chn_attr.rect.x = 0; /* 1920 - 640 - 1280 */
|
||||
chn_attr.rect.y = 480; /* 1200 - 0 - 720 */
|
||||
chn_attr.rect.width = 1280;
|
||||
chn_attr.rect.height = 720;
|
||||
}
|
||||
|
||||
|
||||
chn_attr.priority = priority;
|
||||
|
||||
@@ -921,8 +897,6 @@ static td_s32 sample_comm_vo_get_vo_layer_attr(sample_vo_cfg *vo_config, ot_vo_v
|
||||
if (memcmp(&vo_config->disp_rect, &def_disp_rect, sizeof(ot_rect)) != 0) {
|
||||
layer_attr->display_rect.width = vo_config->disp_rect.width;
|
||||
layer_attr->display_rect.height = vo_config->disp_rect.height;
|
||||
layer_attr->display_rect.width = vo_config->disp_rect.width;
|
||||
layer_attr->display_rect.height = vo_config->disp_rect.height;
|
||||
}
|
||||
|
||||
layer_attr->img_size.width = layer_attr->display_rect.width;
|
||||
|
||||
@@ -19,6 +19,13 @@
|
||||
#include "it6602.h"
|
||||
#include "it6602_reg.h"
|
||||
|
||||
#include <stdio.h>
|
||||
#include <string.h>
|
||||
#include <fcntl.h>
|
||||
#include <unistd.h>
|
||||
#include <sys/mman.h>
|
||||
|
||||
|
||||
char Firmware_date[] = __DATE__;
|
||||
char Firmware_time[] = __TIME__;
|
||||
|
||||
@@ -52,6 +59,66 @@ void InitMessage()
|
||||
|
||||
}
|
||||
|
||||
static void dump_regs(unsigned long addr, int n)
|
||||
{
|
||||
unsigned long page = addr & ~0xfffUL;
|
||||
int fd = open("/dev/mem", O_RDWR | O_SYNC);
|
||||
void *m;
|
||||
int i;
|
||||
|
||||
if (fd < 0) { perror("open /dev/mem"); return; }
|
||||
m = mmap(NULL, 0x10000, PROT_READ | PROT_WRITE, MAP_SHARED, fd, page);
|
||||
if (m == MAP_FAILED) { perror("mmap"); close(fd); return; }
|
||||
|
||||
for (i = 0; i < n; i++)
|
||||
printf(" %08lx: %08x\n", addr + i * 4,
|
||||
*(volatile unsigned int *)((char *)m + (addr - page) + i * 4));
|
||||
|
||||
munmap(m, 0x10000);
|
||||
close(fd);
|
||||
}
|
||||
|
||||
static void it66021_reset_gpio(void)
|
||||
{
|
||||
unsigned long base = 0x11095000; /* PL061 gpio_chip5 */
|
||||
int fd = open("/dev/mem", O_RDWR | O_SYNC);
|
||||
void *m;
|
||||
|
||||
if (fd < 0) { perror("open"); return; }
|
||||
m = mmap(NULL, 0x1000, PROT_READ | PROT_WRITE, MAP_SHARED, fd, base);
|
||||
if (m == MAP_FAILED) { perror("mmap"); close(fd); return; }
|
||||
|
||||
printf("GPIO5 before: DATA=0x%02x DIR=0x%02x AFSEL=0x%02x DEN=0x%02x\n",
|
||||
*(volatile unsigned char *)((char *)m + 0x008),
|
||||
*(volatile unsigned char *)((char *)m + 0x400),
|
||||
*(volatile unsigned char *)((char *)m + 0x420),
|
||||
*(volatile unsigned char *)((char *)m + 0x51c));
|
||||
|
||||
/* 释放复位(bit1)：输出 + 数字使能 + 拉高 */
|
||||
*(volatile unsigned char *)((char *)m + 0x400) |= 0x02; /* DIR */
|
||||
*(volatile unsigned char *)((char *)m + 0x51c) |= 0x02; /* DEN */
|
||||
*(volatile unsigned char *)((char *)m + 0x008) = 0x02; /* DATA（PL061 掩码写，bit1） */
|
||||
|
||||
usleep(10000);
|
||||
printf("GPIO5 after : DATA=0x%02x DIR=0x%02x\n",
|
||||
*(volatile unsigned char *)((char *)m + 0x008),
|
||||
*(volatile unsigned char *)((char *)m + 0x400));
|
||||
}
|
||||
|
||||
|
||||
void DumpI2cRegs(const char *tag)
|
||||
{
|
||||
printf("===== I2C dump: %s =====\n", tag);
|
||||
printf("-- I2C1 controller 0x11061000 --\n");
|
||||
dump_regs(0x11061000, 64);
|
||||
printf("-- I2C0 controller 0x11060000 --\n");
|
||||
dump_regs(0x11060000, 64);
|
||||
printf("-- CRG 0x11014280 (I2C0) --\n");
|
||||
dump_regs(0x11014280, 2);
|
||||
printf("-- CRG 0x11014288 (I2C1) --\n");
|
||||
dump_regs(0x11014288, 2);
|
||||
printf("=============================\n");
|
||||
}
|
||||
|
||||
|
||||
|
||||
@@ -64,14 +131,19 @@ void InitMessage()
|
||||
void main( void )
|
||||
{
|
||||
|
||||
USHORT loopinterval;
|
||||
USHORT loopinterval = 0;
|
||||
|
||||
InitMessage();
|
||||
open_i2c_fd();
|
||||
|
||||
it66021_reset_gpio();
|
||||
DumpI2cRegs("before IT6602_fsm_init"); /* ← 加这里，最重要 */
|
||||
|
||||
delay1ms(1000); //for power sequence
|
||||
IT6602_fsm_init();
|
||||
|
||||
DumpI2cRegs("after IT6602_fsm_init"); /* ← 再加这里 */
|
||||
|
||||
while(1)
|
||||
{
|
||||
loopinterval += getloopTicCount();
|
||||
@@ -85,3 +157,4 @@ void main( void )
|
||||
|
||||
}
|
||||
|
||||
|
||||
|
||||
@@ -23,7 +23,7 @@
|
||||
USHORT getloopTicCount()
|
||||
{
|
||||
usleep(5000);
|
||||
return 1;
|
||||
return 5;
|
||||
}
|
||||
|
||||
|
||||
|
||||
@@ -59,7 +59,8 @@ static int fd;
|
||||
int open_i2c_fd()
|
||||
{
|
||||
int ret;
|
||||
fd = open("/dev/i2c-1", O_RDWR);
|
||||
//fd = open("/dev/i2c-1", O_RDWR);
|
||||
fd = open("/dev/i2c-0", O_RDWR);
|
||||
if (fd<0)
|
||||
{
|
||||
printf("Open i2c dev error!\n");
|
||||
|
||||
@@ -450,17 +450,17 @@ struct IT6602_REG_INI IT6602_HDMI_INIT_TABLE[] = {
|
||||
|
||||
{REG_RX_010, 0xFF, 0x17}, //[4]Auto Video Reset [2]Int Reset [1]Audio Reset [0]Video Reset
|
||||
|
||||
{REG_RX_011, 0xFF, 0x1F}, //Port 0：[4]EQ Reset [3]CLKD5 Reset [2]CDR Reset [1]HDCP Reset [0]All logic Reset
|
||||
{REG_RX_018, 0xFF, 0x1F}, //Port 1：[4]EQ Reset [3]CLKD5 Reset [2]CDR Reset [1]HDCP Reset [0]All logic Reset
|
||||
{REG_RX_011, 0xFF, 0x1F}, //Port 0[4]EQ Reset [3]CLKD5 Reset [2]CDR Reset [1]HDCP Reset [0]All logic Reset
|
||||
{REG_RX_018, 0xFF, 0x1F}, //Port 1[4]EQ Reset [3]CLKD5 Reset [2]CDR Reset [1]HDCP Reset [0]All logic Reset
|
||||
|
||||
{REG_RX_012, 0xFF, 0xF8}, //Port 0：[7:3] MHL Logic reset
|
||||
{REG_RX_012, 0xFF, 0xF8}, //Port 0[7:3] MHL Logic reset
|
||||
|
||||
{REG_RX_010, 0xFF, 0x10}, //[4]Auto Video Reset [2]Int Reset [1]Audio Reset [0]Video Reset
|
||||
|
||||
{REG_RX_011, 0xFF, 0xA0}, //Port 0：[7] Enable Auto Reset when Clock is not stable [5]Enable Auto Reset
|
||||
{REG_RX_018, 0xFF, 0xA0}, //Port 1：[7] Enable Auto Reset when Clock is not stable [5]Enable Auto Reset
|
||||
{REG_RX_011, 0xFF, 0xA0}, //Port 0[7] Enable Auto Reset when Clock is not stable [5]Enable Auto Reset
|
||||
{REG_RX_018, 0xFF, 0xA0}, //Port 1[7] Enable Auto Reset when Clock is not stable [5]Enable Auto Reset
|
||||
|
||||
{REG_RX_012, 0xFF, 0x00}, //Port 0：[7:3] MHL Logic reset
|
||||
{REG_RX_012, 0xFF, 0x00}, //Port 0[7:3] MHL Logic reset
|
||||
|
||||
{REG_RX_00F, 0x03, 0x01}, //change bank 1 //2013-0430 Andrew suggestion
|
||||
{REG_RX_1B0, 0x03, 0x01}, // MHL Port Set HPD = 0 at Power On initial state
|
||||
@@ -473,8 +473,8 @@ struct IT6602_REG_INI IT6602_HDMI_INIT_TABLE[] = {
|
||||
|
||||
|
||||
{REG_RX_00F, 0x03, 0x00}, //change bank 0 //2013-0430 Andrew suggestion
|
||||
{REG_RX_017, 0xC0, 0x80}, //Port 0：[7:6] = 10 invert Port 0 input HCLK , CLKD5I //2013-0430 Andrew suggestion
|
||||
{REG_RX_01E, 0xC0, 0x00}, //Port 1：[7:6] = 00 invert Port 1 input TMDS , CLKD5I //2013-0430 Andrew suggestion
|
||||
{REG_RX_017, 0xC0, 0x80}, //Port 0[7:6] = 10 invert Port 0 input HCLK , CLKD5I //2013-0430 Andrew suggestion
|
||||
{REG_RX_01E, 0xC0, 0x00}, //Port 1[7:6] = 00 invert Port 1 input TMDS , CLKD5I //2013-0430 Andrew suggestion
|
||||
|
||||
#ifdef Enable_IT6602_CEC
|
||||
{REG_RX_00E, 0xFF, 0xFF}, //for enable CEC Clock
|
||||
@@ -483,10 +483,10 @@ struct IT6602_REG_INI IT6602_HDMI_INIT_TABLE[] = {
|
||||
|
||||
// {0xFE, 0x80, 0x80}, //BUS10B for FPGA
|
||||
|
||||
{REG_RX_016, 0x08, 0x08}, //Port 0：[3]1: Enable CLKD5 auto power down
|
||||
{REG_RX_01D, 0x08, 0x08}, //Port 1：[3]1: Enable CLKD5 auto power down
|
||||
{REG_RX_016, 0x08, 0x08}, //Port 0[3]1: Enable CLKD5 auto power down
|
||||
{REG_RX_01D, 0x08, 0x08}, //Port 1[3]1: Enable CLKD5 auto power down
|
||||
|
||||
// {0x20, 0x01, 0x30}, //Port 0：AFE control
|
||||
// {0x20, 0x01, 0x30}, //Port 0AFE control
|
||||
|
||||
{REG_RX_02B, 0xFF, 0x07}, //FixTek3D
|
||||
// {REG_RX_031, 0xFF, 0x2C}, //[7:4]Enable repeater function [3:0] SCL hold time count & Update Ri sel
|
||||
@@ -679,7 +679,7 @@ struct IT6602_REG_INI IT6602_HDMI_INIT_TABLE[] = {
|
||||
|
||||
#if defined(_IT66023_)
|
||||
//FIX_ID_016 xxxxx Support Dual Pixel Mode for IT66023 Only
|
||||
{REG_RX_08C, 0x09, 0x09}, // Reg8C[0] = 1 // SPOutMode：// for enable IO Mapping for Signal Pixel mode
|
||||
{REG_RX_08C, 0x09, 0x09}, // Reg8C[0] = 1 // SPOutMode// for enable IO Mapping for Signal Pixel mode
|
||||
//FIX_ID_016 xxxxx
|
||||
#endif
|
||||
|
||||
@@ -711,14 +711,14 @@ static struct IT6602_REG_INI IT6602_MHL_INIT_TABLE[] = {
|
||||
{MHL_RX_53, 0xFF, 0x80}, //[7]=1 disable FW mode
|
||||
|
||||
{MHL_RX_32, 0xFF, 0x0C}, //CBUS arbitration Low time
|
||||
{MHL_RX_81, 0xFF, MHLVersion}, //DCAP00：MHL_VER_MAJOR and MINOR
|
||||
{MHL_RX_82, 0xFF, (PLIM<<5)+(POW<<4)+DEV_TYPE_SINK}, //DCAP02：DEVICE TYPE
|
||||
{MHL_RX_83, 0xFF, ADOPTER_ID_H}, //DCAP03：ADOPTER_ID
|
||||
{MHL_RX_81, 0xFF, MHLVersion}, //DCAP00MHL_VER_MAJOR and MINOR
|
||||
{MHL_RX_82, 0xFF, (PLIM<<5)+(POW<<4)+DEV_TYPE_SINK}, //DCAP02DEVICE TYPE
|
||||
{MHL_RX_83, 0xFF, ADOPTER_ID_H}, //DCAP03ADOPTER_ID
|
||||
{MHL_RX_84, 0xFF, ADOPTER_ID_L},
|
||||
{MHL_RX_8B, 0xFF, DEVICE_ID_H}, //DCAP0B：DEVICE_ID
|
||||
{MHL_RX_8B, 0xFF, DEVICE_ID_H}, //DCAP0BDEVICE_ID
|
||||
{MHL_RX_8C, 0xFF, DEVICE_ID_L},
|
||||
|
||||
{MHL_RX_28, 0x0F, 0x00}, //Port 0：[0] = 0 RS value of CH1 if req_setEQ=1 //2013-0430 Andrew suggestion
|
||||
{MHL_RX_28, 0x0F, 0x00}, //Port 0[0] = 0 RS value of CH1 if req_setEQ=1 //2013-0430 Andrew suggestion
|
||||
|
||||
{MHL_RX_0F, 0x20, 0x20}, //[5]Guard band swap when Pack Mode
|
||||
//FIX_ID_004 xxxxx //Add 100ms calibration for Cbus
|
||||
@@ -2092,11 +2092,11 @@ void IT66023OutputPixelModeSet(unsigned char bSignalPixelMode)
|
||||
{
|
||||
HDMIRX_VIDEO_PRINTF(("IT66023OutputPixelModeSet( ) 111111111111 Signal Pixel Mode\r\n"));
|
||||
// 1 . Signal Pixel Mode
|
||||
// Reg0D[3] = 0 // EnPHFClk：0 for disable PHFCLK for signal pixel mode
|
||||
// Reg8C[0] = 1 // SPOutMode：// for enable IO Mapping for Signal Pixel mode
|
||||
// Reg8C[3] = 1 // VDIO3en：// for enable QA IO
|
||||
// Reg8B[0] = 0 // EnDualPixel：0 for disable Dual Pixel mode
|
||||
// Reg8B[7] = 1 // PWDDownDualData：// for gating dual pix data output
|
||||
// Reg0D[3] = 0 // EnPHFClk0 for disable PHFCLK for signal pixel mode
|
||||
// Reg8C[0] = 1 // SPOutMode// for enable IO Mapping for Signal Pixel mode
|
||||
// Reg8C[3] = 1 // VDIO3en// for enable QA IO
|
||||
// Reg8B[0] = 0 // EnDualPixel0 for disable Dual Pixel mode
|
||||
// Reg8B[7] = 1 // PWDDownDualData// for gating dual pix data output
|
||||
hdmirxset(REG_RX_00D, 0x08, 0x00);
|
||||
hdmirxset(REG_RX_08C, 0x09, 0x09);
|
||||
hdmirxset(REG_RX_08B, 0x81, 0x80);
|
||||
@@ -2106,11 +2106,11 @@ void IT66023OutputPixelModeSet(unsigned char bSignalPixelMode)
|
||||
{
|
||||
HDMIRX_VIDEO_PRINTF(("IT66023OutputPixelModeSet( ) 00000000000000 Dual Pixel Mode\r\n"));
|
||||
// 2. Dual Pixel Mode
|
||||
// Reg0D[3] = 1 // EnPHFClk：// for enable PHFCLK for Dual pixel mode
|
||||
// Reg8C[0] = 0 // SPOutMode：0 for Disable IO Mapping for Dual Pixel mode
|
||||
// Reg8C[3] = 1 // VDIO3en：// for enable QA IO
|
||||
// Reg8B[0] = 1 // EnDualPixel：// for enable Dual Pixel mode
|
||||
// Reg8B[7] = 0 // PWDDownDualData：0 for PWD UP DUAL DATA
|
||||
// Reg0D[3] = 1 // EnPHFClk// for enable PHFCLK for Dual pixel mode
|
||||
// Reg8C[0] = 0 // SPOutMode0 for Disable IO Mapping for Dual Pixel mode
|
||||
// Reg8C[3] = 1 // VDIO3en// for enable QA IO
|
||||
// Reg8B[0] = 1 // EnDualPixel// for enable Dual Pixel mode
|
||||
// Reg8B[7] = 0 // PWDDownDualData0 for PWD UP DUAL DATA
|
||||
hdmirxset(REG_RX_00D, 0x08, 0x08);
|
||||
hdmirxset(REG_RX_08C, 0x09, 0x08);
|
||||
hdmirxset(REG_RX_08B, 0x81, 0x01);
|
||||
@@ -6713,7 +6713,7 @@ static void IT6602VideoOutputEnable(unsigned char bEnableOutput)
|
||||
|
||||
//FIX_ID_016 xxxxx Support Dual Pixel Mode for IT66023 Only
|
||||
#if defined(_IT66023_)
|
||||
hdmirxset(REG_RX_08C, 0x08, 0x00); // Reg8C[3] = 0 // VDIO3en：// for disable QA IO
|
||||
hdmirxset(REG_RX_08C, 0x08, 0x00); // Reg8C[3] = 0 // VDIO3en// for disable QA IO
|
||||
#endif
|
||||
//FIX_ID_016 xxxxx
|
||||
|
||||
|
||||
Binary file not shown.
@@ -0,0 +1,421 @@
|
||||
#include <stdio.h>
|
||||
#include <stdlib.h>
|
||||
#include <sys/time.h> // gettimeofday
|
||||
#include <sys/stat.h>
|
||||
#include <string.h>
|
||||
#include <unistd.h>
|
||||
#include <sys/types.h>
|
||||
#include <fcntl.h>
|
||||
#include <sys/mman.h>
|
||||
#include <sys/ioctl.h>
|
||||
#include <sys/socket.h>
|
||||
#include <netinet/in.h>
|
||||
#include <arpa/inet.h>
|
||||
#include <netdb.h>
|
||||
#include <errno.h>
|
||||
|
||||
#include "serial.h"
|
||||
#include "uartinf.h"
|
||||
#include "confile.h"
|
||||
#include "udp_util.h"
|
||||
|
||||
char _rx_data[1024];
|
||||
|
||||
struct lc6600_param{
|
||||
int password;
|
||||
int freq;
|
||||
int power;
|
||||
int bw;
|
||||
int ap_sta;
|
||||
int ip;
|
||||
int setup;
|
||||
};
|
||||
|
||||
char freq1[10];
|
||||
char freq2[10];
|
||||
//char dbm1[5];
|
||||
//char dbm2[5];
|
||||
|
||||
#define RSSI_TIMEOUT_MS 3000 //超时时间
|
||||
#define RSSI_NO_SIGNAL 0x55 //无信号值
|
||||
|
||||
|
||||
|
||||
int setup_lc6600(struct lc6600_param *pparam){
|
||||
int n_read;
|
||||
char *read_ok;
|
||||
char str[30];
|
||||
|
||||
uart_write(ROUTE_UART, "AT+CFUN=0\r");
|
||||
n_read = uart_read(ROUTE_UART, _rx_data);
|
||||
read_ok = strstr(_rx_data,"OK");
|
||||
if(read_ok == NULL){
|
||||
printf("can not exce AT+CFUN=0");
|
||||
}
|
||||
sleep(1);
|
||||
//password
|
||||
sprintf(str,"AT^DAPI=%d\r",pparam->password);
|
||||
uart_write(ROUTE_UART, str);
|
||||
printf("%s\n",str);
|
||||
n_read = uart_read(ROUTE_UART, _rx_data);
|
||||
read_ok = strstr(_rx_data,"OK");
|
||||
if(read_ok == NULL){
|
||||
printf("can not exce AT^DAPI");
|
||||
}
|
||||
sleep(1);
|
||||
// 1 center 2 station
|
||||
sprintf(str,"AT^DDTC=%d\r",pparam->ap_sta);
|
||||
uart_write(ROUTE_UART, str);
|
||||
printf("%s\n",str);
|
||||
n_read = uart_read(ROUTE_UART, _rx_data);
|
||||
read_ok = strstr(_rx_data,"OK");
|
||||
if(read_ok == NULL){
|
||||
printf("can not exce AT^DDTC");
|
||||
}
|
||||
sleep(1);
|
||||
|
||||
// sprintf(str,"AT^DDTC=%d\r",pparam->ap_sta);
|
||||
uart_write(ROUTE_UART, "AT^DSTC=2\r");
|
||||
printf("AT^DSTC\n");
|
||||
n_read = uart_read(ROUTE_UART, _rx_data);
|
||||
read_ok = strstr(_rx_data,"OK");
|
||||
if(read_ok == NULL){
|
||||
printf("can not exce AT^DDSTC");
|
||||
}
|
||||
sleep(1);
|
||||
|
||||
|
||||
// 2 5M 3 10M 4 15M 5 20M "25" dbm
|
||||
sprintf(str,"AT^DRPS=,%d,\"%d\"\r",pparam->bw,pparam->power);
|
||||
uart_write(ROUTE_UART, str);
|
||||
printf("%s\n",str);
|
||||
n_read = uart_read(ROUTE_UART, _rx_data);
|
||||
read_ok = strstr(_rx_data,"OK");
|
||||
if(read_ok == NULL){
|
||||
printf("can not exce AT^DRPS\n");
|
||||
}
|
||||
sleep(1);
|
||||
// 01 800M 04 1.4G 08 2.4G
|
||||
sprintf(str,"AT^DAOCNDI=0%d\r",pparam->freq);
|
||||
uart_write(ROUTE_UART, str);
|
||||
printf("%s\n",str);
|
||||
n_read = uart_read(ROUTE_UART, _rx_data);
|
||||
read_ok = strstr(_rx_data,"OK");
|
||||
if(read_ok == NULL){
|
||||
printf("can not exce AT^DAOCNDI\n");
|
||||
}
|
||||
|
||||
sleep(1);
|
||||
|
||||
|
||||
sprintf(str,"AT^NETIFCFG=2,\"192.168.2.%d\"\r",pparam->ip);
|
||||
uart_write(ROUTE_UART, str);
|
||||
printf("%s\n",str);
|
||||
n_read = uart_read(ROUTE_UART, _rx_data);
|
||||
read_ok = strstr(_rx_data,"OK");
|
||||
if(read_ok == NULL){
|
||||
printf("can not exce AT^DAOCNDI\n");
|
||||
}
|
||||
|
||||
sleep(1);
|
||||
|
||||
uart_write(ROUTE_UART, "AT+CFUN=1\r");
|
||||
n_read = uart_read(ROUTE_UART, _rx_data);
|
||||
read_ok = strstr(_rx_data,"OK");
|
||||
if(read_ok == NULL){
|
||||
printf("can not exce AT+CFUN=1");
|
||||
}
|
||||
|
||||
|
||||
|
||||
}
|
||||
|
||||
static long elapsed_ms(struct timeval *start, struct timeval *end)
|
||||
{
|
||||
return (end->tv_sec - start->tv_sec) * 1000L
|
||||
+ (end->tv_usec - start->tv_usec) / 1000L;
|
||||
}
|
||||
|
||||
#if 0
|
||||
|
||||
int get_rx1_freq(char *rx1){
|
||||
|
||||
char *s1;
|
||||
char *s2;
|
||||
char *s3;
|
||||
char *s4;
|
||||
int len;
|
||||
int i;
|
||||
|
||||
s1=strchr(rx1,',');
|
||||
s2=strchr(s1+1,',');
|
||||
s3=strchr(s2+1,',');
|
||||
s4=strchr(s3+1,',');
|
||||
|
||||
len= s2-s1-1;
|
||||
|
||||
for(i=0;i<len;i++){
|
||||
freq1[i] = *(s1+1+i);
|
||||
}
|
||||
printf("freq %s\n",freq1);
|
||||
|
||||
len=s4-s3-1-2; //"-44"
|
||||
|
||||
for(i=0;i<len;i++){
|
||||
dbm1[i]=*(s3+2+i);
|
||||
}
|
||||
printf("dbm1 %s\n",dbm1);
|
||||
|
||||
return 0;
|
||||
|
||||
|
||||
}
|
||||
|
||||
int get_rx1_dbm(char *rx1){
|
||||
|
||||
char *s1;
|
||||
char *s2;
|
||||
char *s3;
|
||||
char *s4;
|
||||
int len;
|
||||
int i;
|
||||
|
||||
s1=strchr(rx1,',');
|
||||
s2=strchr(s1+1,',');
|
||||
s3=strchr(s2+1,',');
|
||||
s4=strchr(s3+1,',');
|
||||
|
||||
len= s2-s1-1;
|
||||
|
||||
for(i=0;i<len;i++){
|
||||
freq1[i] = *(s1+1+i);
|
||||
}
|
||||
//printf("freq %s\n",freq1);
|
||||
|
||||
len=s3-s2-1-2; //"-44"
|
||||
|
||||
for(i=0;i<len;i++){
|
||||
dbm1[i]=*(s2+2+i);
|
||||
}
|
||||
printf("dbm1 %s\n",dbm1);
|
||||
|
||||
return 0;
|
||||
|
||||
|
||||
}
|
||||
|
||||
int get_rx2_dbm(char *rx1){
|
||||
|
||||
char *s1;
|
||||
char *s2;
|
||||
char *s3;
|
||||
char *s4;
|
||||
int len;
|
||||
int i;
|
||||
|
||||
s1=strchr(rx1,',');
|
||||
s2=strchr(s1+1,',');
|
||||
s3=strchr(s2+1,',');
|
||||
s4=strchr(s3+1,',');
|
||||
|
||||
len= s2-s1-1;
|
||||
|
||||
for(i=0;i<len;i++){
|
||||
freq1[i] = *(s1+1+i);
|
||||
}
|
||||
printf("freq %s\n",freq1);
|
||||
|
||||
len=s3-s2-1-2; //"-44"
|
||||
|
||||
for(i=0;i<len;i++){
|
||||
dbm2[i]=*(s2+2+i);
|
||||
}
|
||||
printf("dbm2 %s\n",dbm2);
|
||||
|
||||
return 0;
|
||||
|
||||
|
||||
}
|
||||
|
||||
|
||||
|
||||
int get_rx2_freq(char *rx2){
|
||||
|
||||
char *s1;
|
||||
char *s2;
|
||||
char *s3;
|
||||
char *s4;
|
||||
int len;
|
||||
int i;
|
||||
|
||||
s1=strchr(rx2,',');
|
||||
s2=strchr(s1+1,',');
|
||||
s3=strchr(s2+1,',');
|
||||
s4=strchr(s3+1,',');
|
||||
|
||||
len= s2-s1-1;
|
||||
|
||||
for(i=0;i<len;i++){
|
||||
freq2[i] = *(s1+1+i);
|
||||
}
|
||||
printf("freq %s\n",freq2);
|
||||
|
||||
len=s4-s3-1-2; //"-44"
|
||||
|
||||
for(i=0;i<len;i++){
|
||||
dbm2[i]=*(s3+2+i);
|
||||
}
|
||||
printf("dbm1 %s\n",dbm1);
|
||||
|
||||
return 0;
|
||||
|
||||
|
||||
}
|
||||
|
||||
|
||||
#endif
|
||||
|
||||
|
||||
|
||||
int main (int argc, char *argv[])
|
||||
{
|
||||
int n_read;
|
||||
int i;
|
||||
struct lc6600_param lc6600;
|
||||
|
||||
char buffer[1024];
|
||||
char rssi1[3];
|
||||
char rssi2[3];
|
||||
//char ip[15];
|
||||
char index[1];
|
||||
//char *rx1;
|
||||
//char *rx2;
|
||||
//int rssi1;
|
||||
//int rssi2;
|
||||
int dbm1;
|
||||
int dbm2;
|
||||
char *ip_str;
|
||||
//char *ip_str1;
|
||||
|
||||
char *buffer_freq;
|
||||
char freq_str[6];
|
||||
int freq;
|
||||
int fq;
|
||||
|
||||
int fd_param;
|
||||
int *buffer_param;
|
||||
|
||||
struct timeval tv_rx1 = {0, 0}, tv_rx2 = {0, 0}, tv_now;
|
||||
|
||||
int ip_len;
|
||||
int len;
|
||||
n_read = uart_init(ROUTE_UART, "/dev/ttyAMA2", 115200, 'N');
|
||||
if(n_read <=0 ) {
|
||||
printf("open /dev/ttyAMA2 failed\n");
|
||||
return -1;
|
||||
}
|
||||
|
||||
lc6600.ap_sta = atoi(argv[1]);
|
||||
|
||||
|
||||
|
||||
fd_param = shm_open("/param.txt",O_RDWR|O_CREAT|O_EXCL,0777);
|
||||
if(fd_param < 0){
|
||||
fd_param = shm_open("/param.txt",O_RDWR,0777);
|
||||
}else
|
||||
ftruncate(fd_param,4096);
|
||||
buffer_param= mmap(NULL,4096,PROT_READ|PROT_WRITE,MAP_SHARED,fd_param,0);
|
||||
|
||||
#if 1
|
||||
uart_write(ROUTE_UART, "AT^DRPS?\r");
|
||||
n_read = uart_read(ROUTE_UART, _rx_data);
|
||||
printf("%s\n",_rx_data);
|
||||
if(n_read>0){
|
||||
buffer_freq=strstr(_rx_data,"^DRPS:");
|
||||
memcpy(freq_str,buffer_freq+6,6);
|
||||
|
||||
printf("drps : %s\n",freq_str);
|
||||
freq = atoi(freq_str);
|
||||
|
||||
printf("freq %d \n",freq);
|
||||
buffer_param[3]=freq;
|
||||
}else{
|
||||
printf("no freq\n");
|
||||
}
|
||||
#endif
|
||||
|
||||
//freq=atoi(argv[3]);
|
||||
// buffer_param[0] = 0x55;
|
||||
//buffer_param[3] = 14300;
|
||||
if(lc6600.ap_sta == 1){
|
||||
uart_write(ROUTE_UART, "AT^DAPR=1\r");
|
||||
// n_read = uart_read(ROUTE_UART, _rx_data);
|
||||
// printf("%s\n",_rx_data);
|
||||
|
||||
|
||||
while(1){
|
||||
|
||||
gettimeofday(&tv_now, NULL);
|
||||
|
||||
if (tv_rx1.tv_sec == 0 || elapsed_ms(&tv_rx1, &tv_now) > RSSI_TIMEOUT_MS) {
|
||||
buffer_param[1] = RSSI_NO_SIGNAL;
|
||||
printf("rx1 no signal timeout\n");
|
||||
}
|
||||
|
||||
if (tv_rx2.tv_sec == 0 || elapsed_ms(&tv_rx2, &tv_now) > RSSI_TIMEOUT_MS) {
|
||||
buffer_param[2] = RSSI_NO_SIGNAL;
|
||||
printf("rx2 no signal timeout\n");
|
||||
}
|
||||
|
||||
|
||||
n_read = uart_read(ROUTE_UART, _rx_data);
|
||||
|
||||
printf("%s\n",_rx_data);
|
||||
|
||||
#if 1
|
||||
if(n_read > 10){
|
||||
|
||||
//ip_str=strstr(_rx_data,argv[2]);
|
||||
//ip_str=strstr(_rx_data,"192.168.1.15");
|
||||
//ip_len = strlen(ip_str);
|
||||
//printf("ip_str %d \n ",ip_len);
|
||||
ip_str=strstr(_rx_data,argv[2]);
|
||||
ip_len = strlen(argv[2]);
|
||||
if(ip_str){
|
||||
//buffer_param[0] = 0x55;
|
||||
//printf("ip_str %s \n ",ip_str);
|
||||
memcpy(index,ip_str+(ip_len+2),1);
|
||||
//printf("index %s \n ",index);
|
||||
|
||||
if(strcmp(index, "1") == 0){
|
||||
memcpy(rssi1,ip_str+(ip_len+5),3);
|
||||
dbm1 = atoi(rssi1);
|
||||
printf("++dbm1:%d\n",dbm1);
|
||||
buffer_param[1] = dbm1;
|
||||
gettimeofday(&tv_rx1, NULL);
|
||||
}
|
||||
|
||||
if(strcmp(index, "2") == 0){
|
||||
memcpy(rssi2,ip_str+(ip_len+5),3);
|
||||
dbm2 = atoi(rssi2);
|
||||
printf("++dbm2:%d\n",dbm2);
|
||||
buffer_param[2] = dbm2;
|
||||
gettimeofday(&tv_rx2, NULL);
|
||||
}
|
||||
|
||||
}else{
|
||||
printf("no signal\n");
|
||||
}
|
||||
|
||||
}
|
||||
else{
|
||||
printf("no \n");
|
||||
uart_write(ROUTE_UART, "AT^DAPR=1\r");
|
||||
// buffer_param[0] = 0xAA;
|
||||
}
|
||||
|
||||
#endif
|
||||
}
|
||||
}
|
||||
|
||||
}
|
||||
Binary file not shown.
@@ -732,7 +732,7 @@ if((port == 20000) && (strcmp(fSubsession.mediumName(), "audio") == 0)){
|
||||
|
||||
for(i=0;i<iter;i++){
|
||||
sendto(socket_descriptor,&fReceiveBuffer[i*1472],1472,0,(struct sockaddr *)&address,sizeof(address));
|
||||
#if 1 //luzhi
|
||||
#if 0 //luzhi
|
||||
if(port == 20000){
|
||||
sendto(socket_descriptor,&fReceiveBuffer[i*1472],1472,0,(struct sockaddr *)&address1,sizeof(address1));
|
||||
}
|
||||
@@ -750,7 +750,7 @@ if((port == 20000) && (strcmp(fSubsession.mediumName(), "audio") == 0)){
|
||||
|
||||
if(rem > 0){
|
||||
sendto(socket_descriptor,&fReceiveBuffer[i*1472],rem,0,(struct sockaddr *)&address,sizeof(address));
|
||||
#if 1
|
||||
#if 0
|
||||
if(port == 20000){
|
||||
sendto(socket_descriptor,&fReceiveBuffer[i*1472],rem,0,(struct sockaddr *)&address1,sizeof(address1));
|
||||
}
|
||||
@@ -800,7 +800,7 @@ if((port == 20000) && (strcmp(fSubsession.mediumName(), "audio") == 0)){
|
||||
|
||||
#endif
|
||||
|
||||
#if 1 //luzhi save.h265
|
||||
#if 0 //luzhi save.h265
|
||||
FILE *fp1 = fopen("save.h265","a+b");
|
||||
if(fp1){
|
||||
fwrite(fReceiveBuffer,frameSize+4,1,fp1);
|
||||
|
||||
@@ -0,0 +1,404 @@
|
||||
#include <stdio.h>
|
||||
#include <stdlib.h>
|
||||
#include <sys/time.h> // gettimeofday
|
||||
#include <sys/stat.h>
|
||||
#include <string.h>
|
||||
#include <unistd.h>
|
||||
#include <sys/types.h>
|
||||
#include <fcntl.h>
|
||||
#include <sys/mman.h>
|
||||
#include <sys/ioctl.h>
|
||||
#include <sys/socket.h>
|
||||
#include <netinet/in.h>
|
||||
#include <arpa/inet.h>
|
||||
#include <netdb.h>
|
||||
#include <errno.h>
|
||||
#include <time.h> /* 新增：clock_gettime / clock_nanosleep */
|
||||
#include <pthread.h>
|
||||
#include "serial.h"
|
||||
#include "uartinf.h"
|
||||
#include <stdbool.h>
|
||||
|
||||
#define RECV_PORT 12000 // UDP接收端口
|
||||
#define SEND_PORT 12001 // 发送端口（UART转NET）
|
||||
|
||||
/* ===================== 网络帧协议定义 ===================== */
|
||||
#define NET_FRAME_LEN 32 /* 收/发报文固定长度 */
|
||||
#define NET_TAIL 0xBB /* 帧尾 */
|
||||
|
||||
#define PAYLOAD_LEN 30 /* 帧长度 byte0..29 */
|
||||
#define BYTE_MODE 30 /* 接收帧 mode 字段偏移（0-4） */
|
||||
#define BYTE_TAIL 31 /* 接收帧帧尾偏移 */
|
||||
|
||||
#define CHECKSUM_END 30 /* 校验和覆盖 byte0..byte30（含） */
|
||||
#define NET_FRAME_MAX_LEN 256 /* recvfrom 缓冲大小 */
|
||||
|
||||
#define BYTE_NOSIG0 25 /* byte25 = 视频流0无信号标志（1=无信号，0=有信号） */
|
||||
#define BYTE_NOSIG1 26 /* byte26 = 视频流1无信号标志（1=无信号，0=有信号） */
|
||||
#define BYTE_RSSI1 28 /* 信号包=RSSI1；设备包=哨兵 */
|
||||
#define BYTE_RSSI2 29 /* 信号包=RSSI2；设备包=哨兵 */
|
||||
#define SIG_MARK 0x5A /* 设备包 byte28/29 哨兵值 */
|
||||
#define SIGNAL_INTERVAL_MS 100 /* 独立信号包发送间隔(ms) */
|
||||
#define FRAME_HEAD 0x11 /* 上行帧帧头(byte0)，面板校验要求 */
|
||||
#define FRAME_TAIL 0x22 /* 上行帧帧尾(byte30)，面板校验要求 */
|
||||
#define FRAME_HEAD_TX 0xAA /* 下行帧帧头(byte0)，设备→面板 */
|
||||
|
||||
|
||||
/* ===================== 共享内存 ===================== */
|
||||
#define SHM_MSG_NAME "/video_switch"
|
||||
#define SHM_MODE_IDX 0 /* switch_mode -> shm[0]（即 switch_video[0]） */
|
||||
|
||||
|
||||
static int *shm_msg = NULL;
|
||||
static int *buffer_param = NULL; /* 新增：/param.txt 共享内存，供信号线程读 RSSI */
|
||||
|
||||
char _rx_data[200];
|
||||
|
||||
|
||||
static int socket_descriptor;
|
||||
static struct sockaddr_in address;
|
||||
|
||||
bool first = false;
|
||||
|
||||
int socket_descriptor_recv;
|
||||
struct sockaddr_in address_recv;
|
||||
pthread_attr_t attr;
|
||||
pthread_t pkts_thread;
|
||||
|
||||
/* 打开共享内存 /param.txt（由 lc6600_uart 进程写入 RSSI） */
|
||||
static int *param_memory_open(void) {
|
||||
int fd = shm_open("/param.txt", O_RDWR, 0777);
|
||||
if (fd < 0) {
|
||||
fd = shm_open("/param.txt", O_RDWR | O_CREAT, 0777);
|
||||
if (fd < 0) { perror("shm_open /param.txt"); return NULL; }
|
||||
if (ftruncate(fd, 4096) == -1) { perror("ftruncate /param.txt"); return NULL; }
|
||||
}
|
||||
int *retval = mmap(NULL, 4096, PROT_READ | PROT_WRITE, MAP_SHARED, fd, 0);
|
||||
if (retval == MAP_FAILED) { perror("mmap /param.txt"); return NULL; }
|
||||
return retval;
|
||||
}
|
||||
|
||||
|
||||
static int *switch_memory_open(void) {
|
||||
char buf[128];
|
||||
int fd;
|
||||
sprintf(buf, SHM_MSG_NAME);
|
||||
fd = shm_open(buf, O_CREAT | O_RDWR, S_IRUSR | S_IWUSR);
|
||||
if(fd < 0) { perror("shm_open"); exit(1); }
|
||||
if (ftruncate(fd, 4096) == -1) { perror("ftruncate"); exit(1); }
|
||||
int *retval = mmap(NULL, 4096, PROT_READ | PROT_WRITE, MAP_SHARED, fd, 0);
|
||||
return retval;
|
||||
}
|
||||
|
||||
|
||||
int init_net_recv(int port){
|
||||
|
||||
int i;
|
||||
struct timeval tv;
|
||||
|
||||
bzero(&address_recv,sizeof(struct sockaddr_in));
|
||||
address_recv.sin_family=AF_INET;
|
||||
address_recv.sin_addr.s_addr=htonl(INADDR_ANY);
|
||||
address_recv.sin_port=htons(port);
|
||||
|
||||
socket_descriptor_recv=socket(AF_INET,SOCK_DGRAM,0);//IPV4
|
||||
|
||||
tv.tv_sec = 2;
|
||||
tv.tv_usec = 0;
|
||||
if (setsockopt(socket_descriptor_recv, SOL_SOCKET, SO_RCVTIMEO, &tv, sizeof(tv)) < 0) {
|
||||
printf("socket option SO_RCVTIMEO not support\n");
|
||||
return -1;
|
||||
}
|
||||
|
||||
|
||||
|
||||
if (bind(socket_descriptor_recv, (struct sockaddr *)&address_recv, sizeof(struct sockaddr_in)) < 0)
|
||||
{
|
||||
perror("bind");
|
||||
exit(1);
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
|
||||
|
||||
int udp_init(char *ip, int port){
|
||||
|
||||
|
||||
bzero(&address,sizeof(address));
|
||||
address.sin_family=AF_INET;
|
||||
address.sin_addr.s_addr=inet_addr(ip);
|
||||
address.sin_port=htons(port);
|
||||
|
||||
|
||||
socket_descriptor=socket(AF_INET,SOCK_DGRAM,0);//IPV4
|
||||
return 0;
|
||||
}
|
||||
|
||||
#if 0
|
||||
void *net_recv(void *arg)
|
||||
{
|
||||
int i;
|
||||
struct sockaddr_in clientAddr;
|
||||
int len = sizeof(clientAddr);
|
||||
int ret;
|
||||
struct timeval tv;
|
||||
tv.tv_sec = 5;
|
||||
tv.tv_usec = 0;
|
||||
if (setsockopt(socket_descriptor_recv, SOL_SOCKET, SO_RCVTIMEO, &tv, sizeof(tv)) < 0) {
|
||||
printf("socket option SO_RCVTIMEO not support\n");
|
||||
//return -1;
|
||||
}
|
||||
|
||||
char buffer_cmd[200];
|
||||
while(1){
|
||||
i = recvfrom(socket_descriptor_recv, buffer_cmd, 200, 0, (struct sockaddr*)&clientAddr, &len);
|
||||
if(i>0){
|
||||
uart_write_len(ROUTE_UART,buffer_cmd,i);
|
||||
}
|
||||
else{
|
||||
printf(" time_out to receive data\n");
|
||||
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
#endif
|
||||
#if 1
|
||||
void *net_recv(void *arg)
|
||||
{
|
||||
int i, k;
|
||||
struct sockaddr_in clientAddr;
|
||||
socklen_t len;
|
||||
struct timeval tv;
|
||||
|
||||
char buffer_cmd[NET_FRAME_MAX_LEN];
|
||||
char frame_out[NET_FRAME_MAX_LEN];
|
||||
int sum;
|
||||
unsigned char checksum;
|
||||
|
||||
tv.tv_sec = 5;
|
||||
tv.tv_usec = 0;
|
||||
if (setsockopt(socket_descriptor_recv, SOL_SOCKET, SO_RCVTIMEO, &tv, sizeof(tv)) < 0)
|
||||
printf("socket option SO_RCVTIMEO not support\n");
|
||||
|
||||
while (1) {
|
||||
len = sizeof(clientAddr); /* 每次循环重置，recvfrom 会改写 len */
|
||||
i = recvfrom(socket_descriptor_recv, buffer_cmd, NET_FRAME_MAX_LEN, 0,
|
||||
(struct sockaddr*)&clientAddr, &len);
|
||||
if (i <= 0) {
|
||||
printf(" time_out to receive data\n");
|
||||
continue;
|
||||
}
|
||||
|
||||
if (i != NET_FRAME_LEN) {
|
||||
printf("bad frame len=%d\n", i);
|
||||
continue;
|
||||
}
|
||||
|
||||
/* 帧尾校验 */
|
||||
if ((unsigned char)buffer_cmd[BYTE_TAIL] != NET_TAIL) {
|
||||
printf("bad tail=%02x\n", (unsigned char)buffer_cmd[BYTE_TAIL]);
|
||||
continue;
|
||||
}
|
||||
|
||||
/* 解析 mode -> 写共享内存 */
|
||||
if (shm_msg) {
|
||||
static int last_mode = -1;
|
||||
int mode = (unsigned char)buffer_cmd[BYTE_MODE];
|
||||
|
||||
if (mode <= 4) {
|
||||
if (mode != last_mode) {
|
||||
shm_msg[SHM_MODE_IDX] = mode; //写入共享内存 viode_switch
|
||||
last_mode = mode;
|
||||
printf("write shm: mode=%d\n", mode);
|
||||
}
|
||||
}
|
||||
else {
|
||||
printf("filed mode=%d\n", mode);
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
/* 构造下行帧：byte0=0xAA 帧头，byte1..29 原样，byte30=0xBB 帧尾 */
|
||||
frame_out[0] = FRAME_HEAD_TX; /* [0] 帧头 0xAA */
|
||||
memcpy(frame_out + 1, buffer_cmd + 1, PAYLOAD_LEN - 1); /* [1..29] 原样 */
|
||||
frame_out[PAYLOAD_LEN] = NET_TAIL; /* [30] 帧尾 0xBB */
|
||||
|
||||
/* 校验和 = byte0..byte30 求和取低8位，写入 byte31 */
|
||||
sum = 0;
|
||||
for (k = 0; k <= CHECKSUM_END; k++)
|
||||
sum += (unsigned char)frame_out[k];
|
||||
checksum = sum & 0xFF;
|
||||
frame_out[PAYLOAD_LEN + 1] = checksum; /* [31] 校验和 */
|
||||
|
||||
|
||||
#if 0
|
||||
/* 打印发出的包 */
|
||||
printf(" send to uart %d bytes:", NET_FRAME_LEN);
|
||||
for (k = 0; k < NET_FRAME_LEN; k++)
|
||||
printf(" %02x", (unsigned char)frame_out[k]);
|
||||
printf("\n");
|
||||
#endif
|
||||
|
||||
uart_write_len(ROUTE_UART, frame_out, NET_FRAME_LEN); //发送给串口
|
||||
}
|
||||
|
||||
return NULL;
|
||||
}
|
||||
|
||||
#endif
|
||||
|
||||
/* 独立信号包线程：与串口收包完全解耦，固定 SIGNAL_INTERVAL_MS 周期发送。
|
||||
* 用绝对时间 clock_nanosleep 对齐发送时刻，避免 sendto/printf 开销累积成漂移。 */
|
||||
void *signal_send(void *arg)
|
||||
{
|
||||
char sig_frame[NET_FRAME_LEN];
|
||||
struct timespec next;
|
||||
int k, sum;
|
||||
|
||||
clock_gettime(CLOCK_MONOTONIC, &next);
|
||||
|
||||
while (1) {
|
||||
memset(sig_frame, 0, NET_FRAME_LEN);
|
||||
sig_frame[0] = (char)FRAME_HEAD; /* byte0 = 0x11 */
|
||||
|
||||
/* byte25/26 = 视频流0/1无信号，byte27 = 布局开关（light_pwm_lvds 的 0x68 按键） */
|
||||
sig_frame[BYTE_NOSIG0] = (shm_msg && shm_msg[2] == 0x55) ? 1 : 0;
|
||||
sig_frame[BYTE_NOSIG1] = (shm_msg && shm_msg[3] == 0x55) ? 1 : 0;
|
||||
sig_frame[27] = (shm_msg && shm_msg[1]) ? 1 : 0;
|
||||
printf("layout byte27 = %d\n", sig_frame[27]);
|
||||
|
||||
if (buffer_param) {
|
||||
sig_frame[BYTE_RSSI1] = (char)buffer_param[1];
|
||||
sig_frame[BYTE_RSSI2] = (char)buffer_param[2];
|
||||
}
|
||||
sig_frame[PAYLOAD_LEN] = (char)FRAME_TAIL; /* byte30 = 0x22 */
|
||||
|
||||
sum = 0;
|
||||
for (k = 0; k <= CHECKSUM_END; k++)
|
||||
sum += (unsigned char)sig_frame[k];
|
||||
sig_frame[CHECKSUM_END + 1] = (char)(sum & 0xFF);
|
||||
|
||||
sendto(socket_descriptor, sig_frame, NET_FRAME_LEN, 0,
|
||||
(struct sockaddr *)&address, sizeof(address));
|
||||
|
||||
/* 下一个发送时刻 = 本次时刻 + 周期，与实际执行耗时无关 */
|
||||
next.tv_nsec += (long)SIGNAL_INTERVAL_MS * 1000000L;
|
||||
while (next.tv_nsec >= 1000000000L) {
|
||||
next.tv_sec++;
|
||||
next.tv_nsec -= 1000000000L;
|
||||
}
|
||||
clock_nanosleep(CLOCK_MONOTONIC, TIMER_ABSTIME, &next, NULL);
|
||||
}
|
||||
|
||||
return NULL;
|
||||
}
|
||||
|
||||
|
||||
int pthread_init()
|
||||
{
|
||||
int ret;
|
||||
pthread_t sig_thread;
|
||||
|
||||
pthread_attr_init(&attr);
|
||||
pthread_attr_setdetachstate(&attr, PTHREAD_CREATE_JOINABLE);
|
||||
ret = pthread_create(&pkts_thread, &attr, net_recv, NULL);
|
||||
|
||||
if(ret){
|
||||
printf("create pthread1 error\n");
|
||||
pthread_attr_destroy(&attr);
|
||||
return 1;
|
||||
}
|
||||
|
||||
ret = pthread_create(&sig_thread, &attr, signal_send, NULL);
|
||||
if(ret){
|
||||
printf("create pthread2 error\n");
|
||||
pthread_attr_destroy(&attr);
|
||||
return 1;
|
||||
}
|
||||
|
||||
pthread_attr_destroy(&attr);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
|
||||
int main (int argc, char *argv[])
|
||||
{
|
||||
int n_read;
|
||||
int i;
|
||||
int count=0;
|
||||
|
||||
char buffer_send[100];
|
||||
int buffer_len;
|
||||
|
||||
n_read = uart_init(ROUTE_UART, "/dev/ttyAMA4", 115200, 'N');
|
||||
if(n_read <=0 ) {
|
||||
printf("open /dev/ttyAMA4 failed\n");
|
||||
return -1;
|
||||
}
|
||||
|
||||
|
||||
|
||||
// udp_init(argv[1], atoi(argv[2]));
|
||||
// init_net_recv(atoi(argv[3]));
|
||||
udp_init("127.0.0.1", SEND_PORT); // 发送目标：本机回环 12001
|
||||
init_net_recv(RECV_PORT); // 接收：0.0.0.0:12000（INADDR_ANY）
|
||||
|
||||
|
||||
shm_msg = switch_memory_open();
|
||||
buffer_param = param_memory_open();
|
||||
|
||||
if (pthread_init()) {
|
||||
printf("pthread_init failed\n");
|
||||
return -1;
|
||||
}
|
||||
|
||||
|
||||
|
||||
while(1){
|
||||
n_read = uart_read(ROUTE_UART, _rx_data);
|
||||
if(n_read > 0 ){
|
||||
int k, sum = 0;
|
||||
|
||||
/* 收包校验：完整 32 字节帧，帧头 0x11、帧尾 0x22、byte31 校验和正确，否则丢弃 */
|
||||
if (n_read < NET_FRAME_LEN) {
|
||||
printf("drop bad frame: len=%d\n", n_read);
|
||||
continue;
|
||||
}
|
||||
if ((unsigned char)_rx_data[0] != FRAME_HEAD ||
|
||||
(unsigned char)_rx_data[CHECKSUM_END] != FRAME_TAIL) {
|
||||
printf("drop bad frame: head=%02x tail=%02x\n",
|
||||
(unsigned char)_rx_data[0], (unsigned char)_rx_data[CHECKSUM_END]);
|
||||
continue;
|
||||
}
|
||||
for (k = 0; k <= CHECKSUM_END; k++)
|
||||
sum += (unsigned char)_rx_data[k];
|
||||
if ((unsigned char)_rx_data[31] != (sum & 0xFF)) {
|
||||
printf("drop bad frame: checksum=%02x expect=%02x\n",
|
||||
(unsigned char)_rx_data[31], (unsigned char)(sum & 0xFF));
|
||||
continue;
|
||||
}
|
||||
|
||||
/* byte28/29 固定哨兵值，RSSI 改由独立信号包承载 */
|
||||
_rx_data[BYTE_RSSI1] = (char)SIG_MARK;
|
||||
_rx_data[BYTE_RSSI2] = (char)SIG_MARK;
|
||||
|
||||
|
||||
/* 和校验：byte0..byte30 求和取低 8 位，写入 byte31 */
|
||||
sum = 0;
|
||||
for (k = 0; k <= CHECKSUM_END; k++)
|
||||
sum += (unsigned char)_rx_data[k];
|
||||
_rx_data[31] = (char)(sum & 0xFF);
|
||||
|
||||
sendto(socket_descriptor, _rx_data, NET_FRAME_LEN, 0, (struct sockaddr *)&address, sizeof(address));
|
||||
}
|
||||
|
||||
}
|
||||
|
||||
}
|
||||
@@ -331,10 +331,10 @@ static td_s32 sample_start_vpss(ot_vpss_grp *vpss_grp, td_u32 vpss_grp_num, td_b
|
||||
vpss_chn_attr[1].frame_rate.src_frame_rate = -1;
|
||||
vpss_chn_attr[1].frame_rate.dst_frame_rate = -1;
|
||||
vpss_chn_attr[1].depth = 0;
|
||||
// vpss_chn_attr[1].mirror_en = TD_FALSE; //TD_TRUE; //180
|
||||
// vpss_chn_attr[1].flip_en = TD_FALSE; //TD_TRUE; //180
|
||||
vpss_chn_attr[1].mirror_en = TD_TRUE; //TD_TRUE; //180
|
||||
vpss_chn_attr[1].flip_en = TD_TRUE; //TD_TRUE; //180
|
||||
vpss_chn_attr[1].mirror_en = TD_FALSE; //TD_TRUE; //180
|
||||
vpss_chn_attr[1].flip_en = TD_FALSE; //TD_TRUE; //180
|
||||
// vpss_chn_attr[1].mirror_en = TD_TRUE; //TD_TRUE; //180
|
||||
// vpss_chn_attr[1].flip_en = TD_TRUE; //TD_TRUE; //180
|
||||
vpss_chn_attr[1].border_en = TD_FALSE;
|
||||
vpss_chn_attr[1].aspect_ratio.mode = OT_ASPECT_RATIO_NONE;
|
||||
}
|
||||
|
||||
Binary file not shown.
Reference in New Issue
Block a user