io.c revision be65202a610ca96aa945789c8b0a7bc3529b556e
1be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho/* 2be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho * This file is part of wl18xx 3be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho * 4be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho * Copyright (C) 2011 Texas Instruments 5be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho * 6be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho * This program is free software; you can redistribute it and/or 7be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho * modify it under the terms of the GNU General Public License 8be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho * version 2 as published by the Free Software Foundation. 9be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho * 10be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho * This program is distributed in the hope that it will be useful, but 11be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho * WITHOUT ANY WARRANTY; without even the implied warranty of 12be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU 13be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho * General Public License for more details. 14be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho * 15be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho * You should have received a copy of the GNU General Public License 16be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho * along with this program; if not, write to the Free Software 17be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 18be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho * 02110-1301 USA 19be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho * 20be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho */ 21be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho 22be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho#include "../wlcore/wlcore.h" 23be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho#include "../wlcore/io.h" 24be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho 25be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho#include "io.h" 26be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho 27be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelhovoid wl18xx_top_reg_write(struct wl1271 *wl, int addr, u16 val) 28be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho{ 29be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho u32 tmp; 30be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho 31be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho if (WARN_ON(addr % 2)) 32be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho return; 33be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho 34be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho if ((addr % 4) == 0) { 35be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho tmp = wl1271_read32(wl, addr); 36be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho tmp = (tmp & 0xffff0000) | val; 37be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho wl1271_write32(wl, addr, tmp); 38be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho } else { 39be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho tmp = wl1271_read32(wl, addr - 2); 40be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho tmp = (tmp & 0xffff) | (val << 16); 41be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho wl1271_write32(wl, addr - 2, tmp); 42be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho } 43be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho} 44be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho 45be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelhou16 wl18xx_top_reg_read(struct wl1271 *wl, int addr) 46be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho{ 47be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho u32 val; 48be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho 49be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho if (WARN_ON(addr % 2)) 50be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho return 0; 51be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho 52be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho if ((addr % 4) == 0) { 53be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho /* address is 4-bytes aligned */ 54be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho val = wl1271_read32(wl, addr); 55be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho return val & 0xffff; 56be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho } else { 57be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho val = wl1271_read32(wl, addr - 2); 58be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho return (val & 0xffff0000) >> 16; 59be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho } 60be65202a610ca96aa945789c8b0a7bc3529b556eLuciano Coelho} 61