boolean mddi_host_register_read_int (uint32 reg_addr, uint32 *reg_value_ptr, mddi_host_type host) { mddi_linked_list_type *curr_llist_ptr; mddi_register_access_packet_type *regacc_pkt_ptr; uint16 curr_llist_idx; if (!in_interrupt()) MDDI_MSG_CRIT("Called from TASK context\n"); if (!mddi_host_powered) { MDDI_MSG_ERR("MDDI powered down!\n"); return FALSE; } if (down_trylock(&mddi_host_mutex) != 0) return FALSE; mddi_reg_read_value_ptr = reg_value_ptr; curr_llist_idx = mddi_get_reg_read_llist_item(host, FALSE); if (curr_llist_idx == UNASSIGNED_INDEX) { up(&mddi_host_mutex); return FALSE; } curr_llist_ptr = &llist_extern[host][curr_llist_idx]; curr_llist_ptr->link_controller_flags = 0x11; curr_llist_ptr->packet_header_count = 14; curr_llist_ptr->packet_data_count = 0; curr_llist_ptr->next_packet_pointer = NULL; curr_llist_ptr->packet_data_pointer = NULL; curr_llist_ptr->reserved = 0; regacc_pkt_ptr = &curr_llist_ptr->packet_header.register_pkt; regacc_pkt_ptr->packet_length = curr_llist_ptr->packet_header_count; regacc_pkt_ptr->packet_type = 146; /* register access packet */ regacc_pkt_ptr->bClient_ID = 0; regacc_pkt_ptr->read_write_info = 0x8001; regacc_pkt_ptr->register_address = reg_addr; /* now adjust pointers */ mddi_queue_forward_packets(curr_llist_idx, curr_llist_idx, FALSE, NULL, host); /* need to check if we can write the pointer or not */ up(&mddi_host_mutex); return TRUE; } /* mddi_host_register_read */
int mddi_host_register_read(uint32 reg_addr, uint32 *reg_value_ptr, boolean wait, mddi_host_type host) { mddi_linked_list_type *curr_llist_ptr; mddi_register_access_packet_type *regacc_pkt_ptr; uint16 curr_llist_idx; int ret = 0; if (in_interrupt()) MDDI_MSG_CRIT("Called from ISR context\n"); if (!mddi_host_powered) { MDDI_MSG_ERR("MDDI powered down!\n"); mddi_init(); } down(&mddi_host_mutex); mddi_reg_read_value_ptr = reg_value_ptr; curr_llist_idx = mddi_get_reg_read_llist_item(host, TRUE); if (curr_llist_idx == UNASSIGNED_INDEX) { up(&mddi_host_mutex); /* need to change this to some sort of wait */ MDDI_MSG_ERR("Attempting to queue up more than 1 reg read\n"); return -EINVAL; } curr_llist_ptr = &llist_extern[host][curr_llist_idx]; curr_llist_ptr->link_controller_flags = 0x11; curr_llist_ptr->packet_header_count = 14; curr_llist_ptr->packet_data_count = 0; curr_llist_ptr->next_packet_pointer = NULL; curr_llist_ptr->packet_data_pointer = NULL; curr_llist_ptr->reserved = 0; regacc_pkt_ptr = &curr_llist_ptr->packet_header.register_pkt; regacc_pkt_ptr->packet_length = curr_llist_ptr->packet_header_count; regacc_pkt_ptr->packet_type = 146; /* register access packet */ regacc_pkt_ptr->bClient_ID = 0; regacc_pkt_ptr->read_write_info = 0x8001; regacc_pkt_ptr->register_address = reg_addr; /* now adjust pointers */ mddi_queue_forward_packets(curr_llist_idx, curr_llist_idx, wait, NULL, host); /* need to check if we can write the pointer or not */ up(&mddi_host_mutex); if (wait) { int wait_ret; mddi_linked_list_notify_type *llist_notify_ptr; llist_notify_ptr = &llist_extern_notify[host][curr_llist_idx]; wait_ret = wait_for_completion_timeout( &(llist_notify_ptr->done_comp), 5 * HZ); if (wait_ret <= 0) ret = -EBUSY; if (wait_ret < 0) // printk(KERN_ERR "%s: failed to wait for completion!\n", ; else if (!wait_ret) ; } MDDI_MSG_DEBUG("Reg Read value=0x%x\n", *reg_value_ptr); return ret; } /* mddi_host_register_read */