/**
* Allocate memory and initialize the FPA pools using memory
* from cvmx-bootmem. Sizes of each element in the pools is
* controlled by the cvmx-config.h header file. Specifying
* zero for any parameter will cause that FPA pool to not be
* setup. This is useful if you aren't using some of the
* hardware and want to save memory.
*
* @param packet_buffers
* Number of packet buffers to allocate
* @param work_queue_entries
* Number of work queue entries
* @param pko_buffers
* PKO Command buffers. You should at minimum have two per
* each PKO queue.
* @param tim_buffers
* TIM ring buffer command queues. At least two per timer bucket
* is recommended.
* @param dfa_buffers
* DFA command buffer. A relatively small (32 for example)
* number should work.
* @return Zero on success, non-zero if out of memory
*/
int cvmx_helper_initialize_fpa(int packet_buffers, int work_queue_entries,
int pko_buffers, int tim_buffers, int dfa_buffers)
{
int packet_pool = (int)cvmx_fpa_get_packet_pool();
int wqe_pool = (int)cvmx_fpa_get_wqe_pool();
int outputbuffer_pool = (int)cvmx_fpa_get_pko_pool();
int timer_pool = (int)cvmx_fpa_get_timer_pool();
int dfa_pool = (int)cvmx_fpa_get_dfa_pool();
int rv;
rv = __cvmx_helper_initialize_fpa(packet_pool,
cvmx_fpa_get_packet_pool_block_size(),
packet_buffers,
wqe_pool,
cvmx_fpa_get_wqe_pool_block_size(),
work_queue_entries,
outputbuffer_pool,
cvmx_fpa_get_pko_pool_block_size(),
pko_buffers,
timer_pool,
cvmx_fpa_get_timer_pool_block_size(),
tim_buffers,
dfa_pool,
cvmx_fpa_get_dfa_pool_block_size(),
dfa_buffers
);
return rv;
}
static void __cvmx_ipd_free_ptr_v2(void)
{
int no_wptr = 0;
int i;
union cvmx_ipd_port_ptr_fifo_ctl port_ptr_fifo;
union cvmx_ipd_ptr_count ptr_count;
int packet_pool = (int)cvmx_fpa_get_packet_pool();
int wqe_pool = (int)cvmx_fpa_get_wqe_pool();
ptr_count.u64 = cvmx_read_csr(CVMX_IPD_PTR_COUNT);
/* Handle Work Queue Entry in cn68xx */
if (octeon_has_feature(OCTEON_FEATURE_NO_WPTR)) {
union cvmx_ipd_ctl_status ctl_status;
ctl_status.u64 = cvmx_read_csr(CVMX_IPD_CTL_STATUS);
if (ctl_status.s.no_wptr)
no_wptr = 1;
}
/* Free the prefetched WQE */
if (ptr_count.s.wqev_cnt) {
union cvmx_ipd_next_wqe_ptr next_wqe_ptr;
next_wqe_ptr.u64 = cvmx_read_csr(CVMX_IPD_NEXT_WQE_PTR);
if (no_wptr)
cvmx_fpa_free(cvmx_phys_to_ptr((uint64_t)next_wqe_ptr.s.ptr << 7),
packet_pool, 0);
else
cvmx_fpa_free(cvmx_phys_to_ptr((uint64_t)next_wqe_ptr.s.ptr << 7),
wqe_pool, 0);
}
/* Free all WQE in the fifo */
if (ptr_count.s.wqe_pcnt) {
union cvmx_ipd_free_ptr_fifo_ctl free_fifo;
union cvmx_ipd_free_ptr_value free_ptr_value;
free_fifo.u64 = cvmx_read_csr(CVMX_IPD_FREE_PTR_FIFO_CTL);
for (i = 0; i < ptr_count.s.wqe_pcnt; i++) {
free_fifo.s.cena = 0;
free_fifo.s.raddr = free_fifo.s.max_cnts + (free_fifo.s.wraddr + i) % free_fifo.s.max_cnts;
cvmx_write_csr(CVMX_IPD_FREE_PTR_FIFO_CTL,
free_fifo.u64);
free_fifo.u64 = cvmx_read_csr(CVMX_IPD_FREE_PTR_FIFO_CTL);
free_ptr_value.u64 = cvmx_read_csr(CVMX_IPD_FREE_PTR_VALUE);
if (no_wptr)
cvmx_fpa_free(cvmx_phys_to_ptr((uint64_t)free_ptr_value.s.ptr << 7),
packet_pool, 0);
else
cvmx_fpa_free(cvmx_phys_to_ptr((uint64_t)free_ptr_value.s.ptr << 7),
wqe_pool, 0);
}
free_fifo.s.cena = 1;
cvmx_write_csr(CVMX_IPD_FREE_PTR_FIFO_CTL, free_fifo.u64);
}
/* Free the prefetched packet */
if (ptr_count.s.pktv_cnt) {
union cvmx_ipd_next_pkt_ptr next_pkt_ptr;
next_pkt_ptr.u64 = cvmx_read_csr(CVMX_IPD_NEXT_PKT_PTR);
cvmx_fpa_free(cvmx_phys_to_ptr((uint64_t)next_pkt_ptr.s.ptr << 7),
packet_pool, 0);
}
/* Free the per port prefetched packets */
port_ptr_fifo.u64 = cvmx_read_csr(CVMX_IPD_PORT_PTR_FIFO_CTL);
for (i = 0; i < port_ptr_fifo.s.max_pkt; i++) {
port_ptr_fifo.s.cena = 0;
port_ptr_fifo.s.raddr = i % port_ptr_fifo.s.max_pkt;
cvmx_write_csr(CVMX_IPD_PORT_PTR_FIFO_CTL, port_ptr_fifo.u64);
port_ptr_fifo.u64 = cvmx_read_csr(CVMX_IPD_PORT_PTR_FIFO_CTL);
cvmx_fpa_free(cvmx_phys_to_ptr((uint64_t)port_ptr_fifo.s.ptr << 7),
packet_pool, 0);
}
port_ptr_fifo.s.cena = 1;
cvmx_write_csr(CVMX_IPD_PORT_PTR_FIFO_CTL, port_ptr_fifo.u64);
/* Free all packets in the holding fifo */
if (ptr_count.s.pfif_cnt) {
union cvmx_ipd_hold_ptr_fifo_ctl hold_ptr_fifo;
hold_ptr_fifo.u64 = cvmx_read_csr(CVMX_IPD_HOLD_PTR_FIFO_CTL);
for (i = 0; i < ptr_count.s.pfif_cnt; i++) {
hold_ptr_fifo.s.cena = 0;
hold_ptr_fifo.s.raddr = (hold_ptr_fifo.s.praddr + i) % hold_ptr_fifo.s.max_pkt;
cvmx_write_csr(CVMX_IPD_HOLD_PTR_FIFO_CTL,
hold_ptr_fifo.u64);
hold_ptr_fifo.u64 = cvmx_read_csr(CVMX_IPD_HOLD_PTR_FIFO_CTL);
cvmx_fpa_free(cvmx_phys_to_ptr((uint64_t)hold_ptr_fifo.s.ptr << 7),
packet_pool, 0);
}
hold_ptr_fifo.s.cena = 1;
cvmx_write_csr(CVMX_IPD_HOLD_PTR_FIFO_CTL, hold_ptr_fifo.u64);
}
/* Free all packets in the fifo */
if (ptr_count.s.pkt_pcnt) {
union cvmx_ipd_free_ptr_fifo_ctl free_fifo;
union cvmx_ipd_free_ptr_value free_ptr_value;
free_fifo.u64 = cvmx_read_csr(CVMX_IPD_FREE_PTR_FIFO_CTL);
for (i = 0; i < ptr_count.s.pkt_pcnt; i++) {
free_fifo.s.cena = 0;
free_fifo.s.raddr = (free_fifo.s.praddr + i) % free_fifo.s.max_cnts;
cvmx_write_csr(CVMX_IPD_FREE_PTR_FIFO_CTL,
free_fifo.u64);
free_fifo.u64 = cvmx_read_csr(CVMX_IPD_FREE_PTR_FIFO_CTL);
free_ptr_value.u64 = cvmx_read_csr(CVMX_IPD_FREE_PTR_VALUE);
cvmx_fpa_free(cvmx_phys_to_ptr((uint64_t)free_ptr_value.s.ptr << 7),
packet_pool, 0);
}
free_fifo.s.cena = 1;
cvmx_write_csr(CVMX_IPD_FREE_PTR_FIFO_CTL, free_fifo.u64);
}
}
int main(int argc, char *argv[])
{
/* mandatory function to initialize simple executive application */
cvmx_user_app_init();
sysinfo = cvmx_sysinfo_get();
if (cvmx_is_init_core()) {
/* may need to specify this manually for simulator */
cpu_clock_hz = sysinfo->cpu_clock_hz;
if(init_tasks(NUM_PACKET_BUFFERS) != 0) {
printf("Initialization failed!\n");
exit(-1);
}
/* get the FPA pool number of packet and WQE pools */
packet_pool = cvmx_fpa_get_packet_pool();
wqe_pool = cvmx_fpa_get_wqe_pool();
print_debug_info();
int num_interfaces = cvmx_helper_get_number_of_interfaces();
int interface;
bool found_valid_xaui_port = false;
for (interface=0; interface < num_interfaces && !found_valid_xaui_port; interface++) {
uint32_t num_ports = cvmx_helper_ports_on_interface(interface);
cvmx_helper_interface_mode_t imode = cvmx_helper_interface_get_mode(interface);
if (imode == CVMX_HELPER_INTERFACE_MODE_XAUI) {
printf("\nIdentified XAUI interface with %" PRIu32 " port(s)\n", num_ports);
printf("interface number: %d\n", interface);
uint32_t port;
for (port = 0; port < num_ports; port++) {
if (cvmx_helper_is_port_valid(interface, port)) {
xaui_ipd_port = cvmx_helper_get_ipd_port(interface, port);
printf("xaui_ipd_port: %d\n", xaui_ipd_port);
found_valid_xaui_port = true;
break;
}
}
}
printf("\n");
}
}
/* Wait (stall) until all cores in the given coremask have reached this
* point in the progam execution before proceeding. */
CORE_MASK_BARRIER_SYNC;
if (cvmx_is_init_core()) {
receive_packet();
} else if (cvmx_get_core_num() == 1) {
send_packet();
} else { /* for this program, all cores besides the first two are superfluous */
printf("Superfluous core #%02d\n", cvmx_get_core_num());
return 0;
}
printf("Execution complete for core #%02d\n", cvmx_get_core_num());
return 0;
}
static void __cvmx_ipd_free_ptr_v1(void)
{
unsigned wqe_pool = cvmx_fpa_get_wqe_pool();
int i;
union cvmx_ipd_ptr_count ptr_count;
union cvmx_ipd_prc_port_ptr_fifo_ctl prc_port_fifo;
int packet_pool = (int)cvmx_fpa_get_packet_pool();
/* Only CN38XXp{1,2} cannot read pointer out of the IPD */
if (OCTEON_IS_MODEL(OCTEON_CN38XX_PASS2))
return;
ptr_count.u64 = cvmx_read_csr(CVMX_IPD_PTR_COUNT);
/* Handle Work Queue Entry in cn56xx and cn52xx */
if (octeon_has_feature(OCTEON_FEATURE_NO_WPTR)) {
union cvmx_ipd_ctl_status ctl_status;
ctl_status.u64 = cvmx_read_csr(CVMX_IPD_CTL_STATUS);
if (ctl_status.s.no_wptr)
wqe_pool = packet_pool;
}
/* Free the prefetched WQE */
if (ptr_count.s.wqev_cnt) {
union cvmx_ipd_wqe_ptr_valid wqe_ptr_valid;
wqe_ptr_valid.u64 = cvmx_read_csr(CVMX_IPD_WQE_PTR_VALID);
cvmx_fpa_free(cvmx_phys_to_ptr((uint64_t)wqe_ptr_valid.s.ptr << 7),
wqe_pool, 0);
}
/* Free all WQE in the fifo */
if (ptr_count.s.wqe_pcnt) {
int i;
union cvmx_ipd_pwp_ptr_fifo_ctl pwp_fifo;
pwp_fifo.u64 = cvmx_read_csr(CVMX_IPD_PWP_PTR_FIFO_CTL);
for (i = 0; i < ptr_count.s.wqe_pcnt; i++) {
pwp_fifo.s.cena = 0;
pwp_fifo.s.raddr = pwp_fifo.s.max_cnts + (pwp_fifo.s.wraddr + i) % pwp_fifo.s.max_cnts;
cvmx_write_csr(CVMX_IPD_PWP_PTR_FIFO_CTL, pwp_fifo.u64);
pwp_fifo.u64 = cvmx_read_csr(CVMX_IPD_PWP_PTR_FIFO_CTL);
cvmx_fpa_free(cvmx_phys_to_ptr((uint64_t)pwp_fifo.s.ptr << 7),
wqe_pool, 0);
}
pwp_fifo.s.cena = 1;
cvmx_write_csr(CVMX_IPD_PWP_PTR_FIFO_CTL, pwp_fifo.u64);
}
/* Free the prefetched packet */
if (ptr_count.s.pktv_cnt) {
union cvmx_ipd_pkt_ptr_valid pkt_ptr_valid;
pkt_ptr_valid.u64 = cvmx_read_csr(CVMX_IPD_PKT_PTR_VALID);
cvmx_fpa_free(cvmx_phys_to_ptr((uint64_t)pkt_ptr_valid.s.ptr << 7),
packet_pool, 0);
}
/* Free the per port prefetched packets */
prc_port_fifo.u64 = cvmx_read_csr(CVMX_IPD_PRC_PORT_PTR_FIFO_CTL);
for (i = 0; i < prc_port_fifo.s.max_pkt; i++) {
prc_port_fifo.s.cena = 0;
prc_port_fifo.s.raddr = i % prc_port_fifo.s.max_pkt;
cvmx_write_csr(CVMX_IPD_PRC_PORT_PTR_FIFO_CTL,
prc_port_fifo.u64);
prc_port_fifo.u64 = cvmx_read_csr(CVMX_IPD_PRC_PORT_PTR_FIFO_CTL);
cvmx_fpa_free(cvmx_phys_to_ptr((uint64_t)prc_port_fifo.s.ptr << 7),
packet_pool, 0);
}
prc_port_fifo.s.cena = 1;
cvmx_write_csr(CVMX_IPD_PRC_PORT_PTR_FIFO_CTL, prc_port_fifo.u64);
/* Free all packets in the holding fifo */
if (ptr_count.s.pfif_cnt) {
int i;
union cvmx_ipd_prc_hold_ptr_fifo_ctl prc_hold_fifo;
prc_hold_fifo.u64 = cvmx_read_csr(CVMX_IPD_PRC_HOLD_PTR_FIFO_CTL);
for (i = 0; i < ptr_count.s.pfif_cnt; i++) {
prc_hold_fifo.s.cena = 0;
prc_hold_fifo.s.raddr = (prc_hold_fifo.s.praddr + i) % prc_hold_fifo.s.max_pkt;
cvmx_write_csr(CVMX_IPD_PRC_HOLD_PTR_FIFO_CTL,
prc_hold_fifo.u64);
prc_hold_fifo.u64 = cvmx_read_csr(CVMX_IPD_PRC_HOLD_PTR_FIFO_CTL);
cvmx_fpa_free(cvmx_phys_to_ptr((uint64_t)prc_hold_fifo.s.ptr << 7),
packet_pool, 0);
}
prc_hold_fifo.s.cena = 1;
cvmx_write_csr(CVMX_IPD_PRC_HOLD_PTR_FIFO_CTL,
prc_hold_fifo.u64);
}
/* Free all packets in the fifo */
if (ptr_count.s.pkt_pcnt) {
int i;
union cvmx_ipd_pwp_ptr_fifo_ctl pwp_fifo;
pwp_fifo.u64 = cvmx_read_csr(CVMX_IPD_PWP_PTR_FIFO_CTL);
for (i = 0; i < ptr_count.s.pkt_pcnt; i++) {
pwp_fifo.s.cena = 0;
pwp_fifo.s.raddr = (pwp_fifo.s.praddr + i) % pwp_fifo.s.max_cnts;
cvmx_write_csr(CVMX_IPD_PWP_PTR_FIFO_CTL, pwp_fifo.u64);
pwp_fifo.u64 = cvmx_read_csr(CVMX_IPD_PWP_PTR_FIFO_CTL);
cvmx_fpa_free(cvmx_phys_to_ptr((uint64_t)pwp_fifo.s.ptr << 7),
packet_pool, 0);
}
pwp_fifo.s.cena = 1;
cvmx_write_csr(CVMX_IPD_PWP_PTR_FIFO_CTL, pwp_fifo.u64);
}
}
