Vince Bridgers | 6c3324a9 | 2014-03-17 17:52:37 -0500 | [diff] [blame] | 1 | /* Altera TSE SGDMA and MSGDMA Linux driver |
| 2 | * Copyright (C) 2014 Altera Corporation. All rights reserved |
| 3 | * |
| 4 | * This program is free software; you can redistribute it and/or modify it |
| 5 | * under the terms and conditions of the GNU General Public License, |
| 6 | * version 2, as published by the Free Software Foundation. |
| 7 | * |
| 8 | * This program is distributed in the hope it will be useful, but WITHOUT |
| 9 | * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or |
| 10 | * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for |
| 11 | * more details. |
| 12 | * |
| 13 | * You should have received a copy of the GNU General Public License along with |
| 14 | * this program. If not, see <http://www.gnu.org/licenses/>. |
| 15 | */ |
| 16 | |
| 17 | #include "altera_tse.h" |
| 18 | #include "altera_utils.h" |
| 19 | |
Vince Bridgers | 8983058 | 2014-05-14 14:38:36 -0500 | [diff] [blame] | 20 | void tse_set_bit(void __iomem *ioaddr, size_t offs, u32 bit_mask) |
Vince Bridgers | 6c3324a9 | 2014-03-17 17:52:37 -0500 | [diff] [blame] | 21 | { |
Vince Bridgers | 8983058 | 2014-05-14 14:38:36 -0500 | [diff] [blame] | 22 | u32 value = csrrd32(ioaddr, offs); |
Vince Bridgers | 6c3324a9 | 2014-03-17 17:52:37 -0500 | [diff] [blame] | 23 | value |= bit_mask; |
Vince Bridgers | 8983058 | 2014-05-14 14:38:36 -0500 | [diff] [blame] | 24 | csrwr32(value, ioaddr, offs); |
Vince Bridgers | 6c3324a9 | 2014-03-17 17:52:37 -0500 | [diff] [blame] | 25 | } |
| 26 | |
Vince Bridgers | 8983058 | 2014-05-14 14:38:36 -0500 | [diff] [blame] | 27 | void tse_clear_bit(void __iomem *ioaddr, size_t offs, u32 bit_mask) |
Vince Bridgers | 6c3324a9 | 2014-03-17 17:52:37 -0500 | [diff] [blame] | 28 | { |
Vince Bridgers | 8983058 | 2014-05-14 14:38:36 -0500 | [diff] [blame] | 29 | u32 value = csrrd32(ioaddr, offs); |
Vince Bridgers | 6c3324a9 | 2014-03-17 17:52:37 -0500 | [diff] [blame] | 30 | value &= ~bit_mask; |
Vince Bridgers | 8983058 | 2014-05-14 14:38:36 -0500 | [diff] [blame] | 31 | csrwr32(value, ioaddr, offs); |
Vince Bridgers | 6c3324a9 | 2014-03-17 17:52:37 -0500 | [diff] [blame] | 32 | } |
| 33 | |
Vince Bridgers | 8983058 | 2014-05-14 14:38:36 -0500 | [diff] [blame] | 34 | int tse_bit_is_set(void __iomem *ioaddr, size_t offs, u32 bit_mask) |
Vince Bridgers | 6c3324a9 | 2014-03-17 17:52:37 -0500 | [diff] [blame] | 35 | { |
Vince Bridgers | 8983058 | 2014-05-14 14:38:36 -0500 | [diff] [blame] | 36 | u32 value = csrrd32(ioaddr, offs); |
Vince Bridgers | 6c3324a9 | 2014-03-17 17:52:37 -0500 | [diff] [blame] | 37 | return (value & bit_mask) ? 1 : 0; |
| 38 | } |
| 39 | |
Vince Bridgers | 8983058 | 2014-05-14 14:38:36 -0500 | [diff] [blame] | 40 | int tse_bit_is_clear(void __iomem *ioaddr, size_t offs, u32 bit_mask) |
Vince Bridgers | 6c3324a9 | 2014-03-17 17:52:37 -0500 | [diff] [blame] | 41 | { |
Vince Bridgers | 8983058 | 2014-05-14 14:38:36 -0500 | [diff] [blame] | 42 | u32 value = csrrd32(ioaddr, offs); |
Vince Bridgers | 6c3324a9 | 2014-03-17 17:52:37 -0500 | [diff] [blame] | 43 | return (value & bit_mask) ? 0 : 1; |
| 44 | } |