1 /* 2 * Copyright (c) 2014, Linaro Limited 3 * All rights reserved. 4 * 5 * Redistribution and use in source and binary forms, with or without 6 * modification, are permitted provided that the following conditions are met: 7 * 8 * 1. Redistributions of source code must retain the above copyright notice, 9 * this list of conditions and the following disclaimer. 10 * 11 * 2. Redistributions in binary form must reproduce the above copyright notice, 12 * this list of conditions and the following disclaimer in the documentation 13 * and/or other materials provided with the distribution. 14 * 15 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" 16 * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE 17 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE 18 * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE 19 * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 20 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 21 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 22 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 23 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 24 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 25 * POSSIBILITY OF SUCH DAMAGE. 26 */ 27 #ifndef IO_H 28 #define IO_H 29 30 #include <stdint.h> 31 #include <types_ext.h> 32 #include <utee_defines.h> 33 34 static inline void write8(uint8_t val, vaddr_t addr) 35 { 36 *(volatile uint8_t *)addr = val; 37 } 38 39 static inline void write16(uint16_t val, vaddr_t addr) 40 { 41 *(volatile uint16_t *)addr = val; 42 } 43 44 static inline void write32(uint32_t val, vaddr_t addr) 45 { 46 *(volatile uint32_t *)addr = val; 47 } 48 49 static inline uint8_t read8(vaddr_t addr) 50 { 51 return *(volatile uint8_t *)addr; 52 } 53 54 static inline uint16_t read16(vaddr_t addr) 55 { 56 return *(volatile uint16_t *)addr; 57 } 58 59 static inline uint32_t read32(vaddr_t addr) 60 { 61 return *(volatile uint32_t *)addr; 62 } 63 64 static inline void io_mask8(vaddr_t addr, uint8_t val, uint8_t mask) 65 { 66 write8((read8(addr) & ~mask) | (val & mask), addr); 67 } 68 69 static inline void io_mask16(vaddr_t addr, uint16_t val, uint16_t mask) 70 { 71 write16((read16(addr) & ~mask) | (val & mask), addr); 72 } 73 74 static inline void io_mask32(vaddr_t addr, uint32_t val, uint32_t mask) 75 { 76 write32((read32(addr) & ~mask) | (val & mask), addr); 77 } 78 79 static inline uint64_t get_be64(const void *p) 80 { 81 return TEE_U64_FROM_BIG_ENDIAN(*(const uint64_t *)p); 82 } 83 84 static inline void put_be64(void *p, uint64_t val) 85 { 86 *(uint64_t *)p = TEE_U64_TO_BIG_ENDIAN(val); 87 } 88 89 static inline uint32_t get_be32(const void *p) 90 { 91 return TEE_U32_FROM_BIG_ENDIAN(*(const uint32_t *)p); 92 } 93 94 static inline void put_be32(void *p, uint32_t val) 95 { 96 *(uint32_t *)p = TEE_U32_TO_BIG_ENDIAN(val); 97 } 98 99 static inline uint16_t get_be16(const void *p) 100 { 101 return TEE_U16_FROM_BIG_ENDIAN(*(const uint16_t *)p); 102 } 103 104 static inline void put_be16(void *p, uint16_t val) 105 { 106 *(uint16_t *)p = TEE_U16_TO_BIG_ENDIAN(val); 107 } 108 109 #endif /*IO_H*/ 110