URL
https://opencores.org/ocsvn/ha1588/ha1588/trunk
Subversion Repositories ha1588
[/] [ha1588/] [trunk/] [sim/] [top/] [ptp_drv_bfm/] [ptp_drv_bfm.c] - Rev 74
Go to most recent revision | Compare with Previous | Blame | View Log
/* * ptp_drv_bfm.c * * Copyright (c) 2012, BABY&HW. All rights reserved. * * This library is free software; you can redistribute it and/or * modify it under the terms of the GNU Lesser General Public * License as published by the Free Software Foundation; either * version 2.1 of the License, or (at your option) any later version. * * This library is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU * Lesser General Public License for more details. * * You should have received a copy of the GNU Lesser General Public * License along with this library; if not, write to the Free Software * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, * MA 02110-1301 USA */ #include <stdio.h> #include "svdpi.h" #include "../dpiheader.h" // define RTC address values #define RTC_CTRL 0x00000000 #define RTC_NULL_0x04 0x00000004 #define RTC_NULL_0x08 0x00000008 #define RTC_NULL_0x0C 0x0000000C #define RTC_TIME_SEC_H 0x00000010 #define RTC_TIME_SEC_L 0x00000014 #define RTC_TIME_NSC_H 0x00000018 #define RTC_TIME_NSC_L 0x0000001C #define RTC_PERIOD_H 0x00000020 #define RTC_PERIOD_L 0x00000024 #define RTC_ADJPER_H 0x00000028 #define RTC_ADJPER_L 0x0000002C #define RTC_ADJNUM 0x00000030 #define RTC_NULL_0x34 0x00000034 #define RTC_NULL_0x38 0x00000038 #define RTC_NULL_0x3C 0x0000003C // define RTC control values #define RTC_SET_CTRL_0 0x00 #define RTC_GET_TIME 0x01 #define RTC_SET_ADJ 0x02 #define RTC_SET_PERIOD 0x04 #define RTC_SET_TIME 0x08 #define RTC_SET_RESET 0x10 // define RTC data values #define RTC_SET_PERIOD_H 0x8 // 8ns for 125MHz rtc_clk #define RTC_SET_PERIOD_L 0x0 // define RTC constant #define RTC_ACCMOD_H 0x3B9ACA00 // 1,000,000,000 for 30bit #define RTC_ACCMOD_L 0x0 // 256 for 8bit // define TSU address values #define TSU_RXCTRL 0x00000040 #define TSU_RXQUE_STATUS 0x00000044 #define TSU_NULL_0x48 0x00000048 #define TSU_NULL_0x4C 0x0000004C #define TSU_RXQUE_DATA_HH 0x00000050 #define TSU_RXQUE_DATA_HL 0x00000054 #define TSU_RXQUE_DATA_LH 0x00000058 #define TSU_RXQUE_DATA_LL 0x0000005C #define TSU_TXCTRL 0x00000060 #define TSU_TXQUE_STATUS 0x00000064 #define TSU_NULL_0x68 0x00000068 #define TSU_NULL_0x6C 0x0000006C #define TSU_TXQUE_DATA_HH 0x00000070 #define TSU_TXQUE_DATA_HL 0x00000074 #define TSU_TXQUE_DATA_LH 0x00000078 #define TSU_TXQUE_DATA_LL 0x0000007C // define TSU control values #define TSU_SET_CTRL_0 0x00 #define TSU_GET_RXQUE 0x01 #define TSU_SET_RXRST 0x02 #define TSU_GET_TXQUE 0x01 #define TSU_SET_TXRST 0x02 // define TSU data values #define TSU_MASK_RXMSGID 0xFF000000 // FF to enable 0x0 to 0x7 #define TSU_MASK_TXMSGID 0xFF000000 // FF to enable 0x0 to 0x7 int ptp_drv_bfm_c(double fw_delay) { unsigned int cpu_addr_i; unsigned int cpu_data_i; unsigned int cpu_data_o; // LOAD RTC PERIOD cpu_addr_i = RTC_PERIOD_H; cpu_data_i = RTC_SET_PERIOD_H; cpu_wr(cpu_addr_i, cpu_data_i); cpu_addr_i = RTC_PERIOD_L; cpu_data_i = RTC_SET_PERIOD_L; cpu_wr(cpu_addr_i, cpu_data_i); cpu_addr_i = RTC_CTRL; cpu_data_i = RTC_SET_CTRL_0; cpu_wr(cpu_addr_i, cpu_data_i); cpu_addr_i = RTC_CTRL; cpu_data_i = RTC_SET_PERIOD; cpu_wr(cpu_addr_i, cpu_data_i); // RESET RTC cpu_addr_i = RTC_CTRL; cpu_data_i = RTC_SET_CTRL_0; cpu_wr(cpu_addr_i, cpu_data_i); cpu_addr_i = RTC_CTRL; cpu_data_i = RTC_SET_RESET; cpu_wr(cpu_addr_i, cpu_data_i); // READ RTC SEC AND NS cpu_addr_i = RTC_CTRL; cpu_data_i = RTC_SET_CTRL_0; cpu_wr(cpu_addr_i, cpu_data_i); cpu_addr_i = RTC_CTRL; cpu_data_i = RTC_GET_TIME; cpu_wr(cpu_addr_i, cpu_data_i); do { cpu_addr_i = RTC_CTRL; cpu_rd(cpu_addr_i, &cpu_data_o); //printf("%08x\n", cpu_data_o); } while ((cpu_data_o & RTC_GET_TIME) == 0x0); cpu_addr_i = RTC_TIME_SEC_H; cpu_rd(cpu_addr_i, &cpu_data_o); printf("\ntime: \n%08x\n", cpu_data_o); cpu_addr_i = RTC_TIME_SEC_L; cpu_rd(cpu_addr_i, &cpu_data_o); printf("%08x\n", cpu_data_o); cpu_addr_i = RTC_TIME_NSC_H; cpu_rd(cpu_addr_i, &cpu_data_o); printf("%08x\n", cpu_data_o); cpu_addr_i = RTC_TIME_NSC_L; cpu_rd(cpu_addr_i, &cpu_data_o); printf("%08x\n", cpu_data_o); // LOAD RTC SEC AND NS cpu_addr_i = RTC_TIME_SEC_H; cpu_data_i = 0x0; cpu_wr(cpu_addr_i, cpu_data_i); cpu_addr_i = RTC_TIME_SEC_L; cpu_data_i = 0x1; cpu_wr(cpu_addr_i, cpu_data_i); cpu_addr_i = RTC_TIME_NSC_H; cpu_data_i = RTC_ACCMOD_H - 0xA; cpu_wr(cpu_addr_i, cpu_data_i); cpu_addr_i = RTC_TIME_NSC_L; cpu_data_i = 0x0; cpu_wr(cpu_addr_i, cpu_data_i); cpu_addr_i = RTC_CTRL; cpu_data_i = RTC_SET_CTRL_0; cpu_wr(cpu_addr_i, cpu_data_i); cpu_addr_i = RTC_CTRL; cpu_data_i = RTC_SET_TIME; cpu_wr(cpu_addr_i, cpu_data_i); // LOAD RTC ADJ cpu_addr_i = RTC_ADJNUM; cpu_data_i = 0x100; cpu_wr(cpu_addr_i, cpu_data_i); cpu_addr_i = RTC_ADJPER_H; cpu_data_i = 0x1; cpu_wr(cpu_addr_i, cpu_data_i); cpu_addr_i = RTC_ADJPER_L; cpu_data_i = 0x20; cpu_wr(cpu_addr_i, cpu_data_i); cpu_addr_i = RTC_CTRL; cpu_data_i = RTC_SET_CTRL_0; cpu_wr(cpu_addr_i, cpu_data_i); cpu_addr_i = RTC_CTRL; cpu_data_i = RTC_SET_ADJ; cpu_wr(cpu_addr_i, cpu_data_i); do { cpu_addr_i = RTC_CTRL; cpu_rd(cpu_addr_i, &cpu_data_o); //printf("%08x\n", cpu_data_o); } while ((cpu_data_o & RTC_SET_ADJ) == 0x0); // READ RTC SEC AND NS cpu_addr_i = RTC_CTRL; cpu_data_i = RTC_SET_CTRL_0; cpu_wr(cpu_addr_i, cpu_data_i); cpu_addr_i = RTC_CTRL; cpu_data_i = RTC_GET_TIME; cpu_wr(cpu_addr_i, cpu_data_i); do { cpu_addr_i = RTC_CTRL; cpu_rd(cpu_addr_i, &cpu_data_o); //printf("%08x\n", cpu_data_o); } while ((cpu_data_o & RTC_GET_TIME) == 0x0); cpu_addr_i = RTC_TIME_SEC_H; cpu_rd(cpu_addr_i, &cpu_data_o); printf("\ntime: \n%08x\n", cpu_data_o); cpu_addr_i = RTC_TIME_SEC_L; cpu_rd(cpu_addr_i, &cpu_data_o); printf("%08x\n", cpu_data_o); cpu_addr_i = RTC_TIME_NSC_H; cpu_rd(cpu_addr_i, &cpu_data_o); printf("%08x\n", cpu_data_o); cpu_addr_i = RTC_TIME_NSC_L; cpu_rd(cpu_addr_i, &cpu_data_o); printf("%08x\n", cpu_data_o); int i; int rx_queue_num; int tx_queue_num; // CONFIG TSU cpu_addr_i = TSU_RXQUE_STATUS; cpu_data_i = TSU_MASK_RXMSGID; cpu_wr(cpu_addr_i, cpu_data_i); cpu_addr_i = TSU_TXQUE_STATUS; cpu_data_i = TSU_MASK_TXMSGID; cpu_wr(cpu_addr_i, cpu_data_i); // RESET TSU cpu_addr_i = TSU_RXCTRL; cpu_data_i = TSU_SET_CTRL_0; cpu_wr(cpu_addr_i, cpu_data_i); cpu_addr_i = TSU_RXCTRL; cpu_data_i = TSU_SET_RXRST; cpu_wr(cpu_addr_i, cpu_data_i); cpu_addr_i = TSU_TXCTRL; cpu_data_i = TSU_SET_CTRL_0; cpu_wr(cpu_addr_i, cpu_data_i); cpu_addr_i = TSU_TXCTRL; cpu_data_i = TSU_SET_TXRST; cpu_wr(cpu_addr_i, cpu_data_i); // READ TSU while (1) { // POLL TSU RX STATUS cpu_addr_i = TSU_RXQUE_STATUS; cpu_rd(cpu_addr_i, &cpu_data_o); rx_queue_num = cpu_data_o & 0x00FFFFFF; //printf("%08x\n", rx_queue_num); if (rx_queue_num > 0x0) { for (i=rx_queue_num; i>0; i--) { // READ TSU RX FIFO cpu_addr_i = TSU_RXCTRL; cpu_data_i = TSU_SET_CTRL_0; cpu_wr(cpu_addr_i, cpu_data_i); cpu_addr_i = TSU_RXCTRL; cpu_data_i = TSU_GET_RXQUE; cpu_wr(cpu_addr_i, cpu_data_i); do { cpu_addr_i = TSU_RXCTRL; cpu_rd(cpu_addr_i, &cpu_data_o); //printf("%08x\n", cpu_data_o); } while ((cpu_data_o & TSU_GET_RXQUE) == 0x0); cpu_addr_i = TSU_RXQUE_DATA_HH; cpu_rd(cpu_addr_i, &cpu_data_o); printf("\nRx stamp: \n%08x\n", cpu_data_o); cpu_addr_i = TSU_RXQUE_DATA_HL; cpu_rd(cpu_addr_i, &cpu_data_o); printf("%08x\n", cpu_data_o); cpu_addr_i = TSU_RXQUE_DATA_LH; cpu_rd(cpu_addr_i, &cpu_data_o); printf("%08x\n", cpu_data_o); cpu_addr_i = TSU_RXQUE_DATA_LL; cpu_rd(cpu_addr_i, &cpu_data_o); printf("%08x\n", cpu_data_o); // READ RTC SEC AND NS cpu_addr_i = RTC_CTRL; cpu_data_i = RTC_SET_CTRL_0; cpu_wr(cpu_addr_i, cpu_data_i); cpu_addr_i = RTC_CTRL; cpu_data_i = RTC_GET_TIME; cpu_wr(cpu_addr_i, cpu_data_i); do { cpu_addr_i = RTC_CTRL; cpu_rd(cpu_addr_i, &cpu_data_o); //printf("%08x\n", cpu_data_o); } while ((cpu_data_o & RTC_GET_TIME) == 0x0); cpu_addr_i = RTC_TIME_SEC_H; cpu_rd(cpu_addr_i, &cpu_data_o); printf("\ntime: \n%08x\n", cpu_data_o); cpu_addr_i = RTC_TIME_SEC_L; cpu_rd(cpu_addr_i, &cpu_data_o); printf("%08x\n", cpu_data_o); cpu_addr_i = RTC_TIME_NSC_H; cpu_rd(cpu_addr_i, &cpu_data_o); printf("%08x\n", cpu_data_o); cpu_addr_i = RTC_TIME_NSC_L; cpu_rd(cpu_addr_i, &cpu_data_o); printf("%08x\n", cpu_data_o); } } // POLL TSU TX STATUS cpu_addr_i = TSU_TXQUE_STATUS; cpu_rd(cpu_addr_i, &cpu_data_o); tx_queue_num = cpu_data_o & 0x00FFFFFF; //printf("%08x\n", tx_queue_num); if (tx_queue_num > 0x0) { for (i=tx_queue_num; i>0; i--) { // READ TSU TX FIFO cpu_addr_i = TSU_TXCTRL; cpu_data_i = TSU_SET_CTRL_0; cpu_wr(cpu_addr_i, cpu_data_i); cpu_addr_i = TSU_TXCTRL; cpu_data_i = TSU_GET_TXQUE; cpu_wr(cpu_addr_i, cpu_data_i); do { cpu_addr_i = TSU_TXCTRL; cpu_rd(cpu_addr_i, &cpu_data_o); //printf("%08x\n", cpu_data_o); } while ((cpu_data_o & TSU_GET_TXQUE) == 0x0); cpu_addr_i = TSU_TXQUE_DATA_HH; cpu_rd(cpu_addr_i, &cpu_data_o); printf("\nTx stamp: \n%08x\n", cpu_data_o); cpu_addr_i = TSU_TXQUE_DATA_HL; cpu_rd(cpu_addr_i, &cpu_data_o); printf("%08x\n", cpu_data_o); cpu_addr_i = TSU_TXQUE_DATA_LH; cpu_rd(cpu_addr_i, &cpu_data_o); printf("%08x\n", cpu_data_o); cpu_addr_i = TSU_TXQUE_DATA_LL; cpu_rd(cpu_addr_i, &cpu_data_o); printf("%08x\n", cpu_data_o); // READ RTC SEC AND NS cpu_addr_i = RTC_CTRL; cpu_data_i = RTC_SET_CTRL_0; cpu_wr(cpu_addr_i, cpu_data_i); cpu_addr_i = RTC_CTRL; cpu_data_i = RTC_GET_TIME; cpu_wr(cpu_addr_i, cpu_data_i); do { cpu_addr_i = RTC_CTRL; cpu_rd(cpu_addr_i, &cpu_data_o); //printf("%08x\n", cpu_data_o); } while ((cpu_data_o & RTC_GET_TIME) == 0x0); cpu_addr_i = RTC_TIME_SEC_H; cpu_rd(cpu_addr_i, &cpu_data_o); printf("\ntime: \n%08x\n", cpu_data_o); cpu_addr_i = RTC_TIME_SEC_L; cpu_rd(cpu_addr_i, &cpu_data_o); printf("%08x\n", cpu_data_o); cpu_addr_i = RTC_TIME_NSC_H; cpu_rd(cpu_addr_i, &cpu_data_o); printf("%08x\n", cpu_data_o); cpu_addr_i = RTC_TIME_NSC_L; cpu_rd(cpu_addr_i, &cpu_data_o); printf("%08x\n", cpu_data_o); } } } // READ BACK ALL REGISTERS for (;;) { int t; for (t=0; t<=0xff; t=t+4) { cpu_hd(10); cpu_addr_i = t; cpu_rd(cpu_addr_i, &cpu_data_o); } } return(0); /* Return success (required by tasks) */ }
Go to most recent revision | Compare with Previous | Blame | View Log