| 1 | // SPDX-License-Identifier: GPL-2.0-only |
|---|
| 2 | /* |
|---|
| 3 | * This file is part of wl18xx |
|---|
| 4 | * |
|---|
| 5 | * Copyright (C) 2011 Texas Instruments |
|---|
| 6 | */ |
|---|
| 7 | |
|---|
| 8 | #include "../wlcore/wlcore.h" |
|---|
| 9 | #include "../wlcore/io.h" |
|---|
| 10 | |
|---|
| 11 | #include "io.h" |
|---|
| 12 | |
|---|
| 13 | int wl18xx_top_reg_write(struct wl1271 *wl, int addr, u16 val) |
|---|
| 14 | { |
|---|
| 15 | u32 tmp; |
|---|
| 16 | int ret; |
|---|
| 17 | |
|---|
| 18 | if (WARN_ON(addr % 2)) |
|---|
| 19 | return -EINVAL; |
|---|
| 20 | |
|---|
| 21 | if ((addr % 4) == 0) { |
|---|
| 22 | ret = wlcore_read32(wl, addr, val: &tmp); |
|---|
| 23 | if (ret < 0) |
|---|
| 24 | goto out; |
|---|
| 25 | |
|---|
| 26 | tmp = (tmp & 0xffff0000) | val; |
|---|
| 27 | ret = wlcore_write32(wl, addr, val: tmp); |
|---|
| 28 | } else { |
|---|
| 29 | ret = wlcore_read32(wl, addr: addr - 2, val: &tmp); |
|---|
| 30 | if (ret < 0) |
|---|
| 31 | goto out; |
|---|
| 32 | |
|---|
| 33 | tmp = (tmp & 0xffff) | (val << 16); |
|---|
| 34 | ret = wlcore_write32(wl, addr: addr - 2, val: tmp); |
|---|
| 35 | } |
|---|
| 36 | |
|---|
| 37 | out: |
|---|
| 38 | return ret; |
|---|
| 39 | } |
|---|
| 40 | |
|---|
| 41 | int wl18xx_top_reg_read(struct wl1271 *wl, int addr, u16 *out) |
|---|
| 42 | { |
|---|
| 43 | u32 val = 0; |
|---|
| 44 | int ret; |
|---|
| 45 | |
|---|
| 46 | if (WARN_ON(addr % 2)) |
|---|
| 47 | return -EINVAL; |
|---|
| 48 | |
|---|
| 49 | if ((addr % 4) == 0) { |
|---|
| 50 | /* address is 4-bytes aligned */ |
|---|
| 51 | ret = wlcore_read32(wl, addr, val: &val); |
|---|
| 52 | if (ret >= 0 && out) |
|---|
| 53 | *out = val & 0xffff; |
|---|
| 54 | } else { |
|---|
| 55 | ret = wlcore_read32(wl, addr: addr - 2, val: &val); |
|---|
| 56 | if (ret >= 0 && out) |
|---|
| 57 | *out = (val & 0xffff0000) >> 16; |
|---|
| 58 | } |
|---|
| 59 | |
|---|
| 60 | return ret; |
|---|
| 61 | } |
|---|
| 62 | |
|---|
