diff options
| author | Denis 'GNUtoo' Carikli <GNUtoo@cyberdimension.org> | 2021-06-09 18:02:29 +0200 |
|---|---|---|
| committer | Denis 'GNUtoo' Carikli <GNUtoo@cyberdimension.org> | 2021-06-09 18:02:29 +0200 |
| commit | 99f3de54e09fc5bd17301f97ca9a5efeb92870e4 (patch) | |
| tree | 801f39e3c52aefe0dc403086122f453413423695 | |
| parent | 0730b267d1f0677c34ed640cac14761be9ffb21b (diff) | |
| download | exynos-gpio-tool-99f3de54e09fc5bd17301f97ca9a5efeb92870e4.tar.gz exynos-gpio-tool-99f3de54e09fc5bd17301f97ca9a5efeb92870e4.tar.bz2 exynos-gpio-tool-99f3de54e09fc5bd17301f97ca9a5efeb92870e4.zip | |
devmem2.c: fix whitespace issues
Signed-off-by: Denis 'GNUtoo' Carikli <GNUtoo@cyberdimension.org>
| -rw-r--r-- | devmem2.c | 100 |
1 files changed, 52 insertions, 48 deletions
@@ -33,7 +33,7 @@ * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. - * + * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA @@ -54,72 +54,76 @@ #include "devmem2.h" -#define FATAL do { fprintf(stderr, "Error at line %d, file %s (%d) [%s]\n", \ - __LINE__, __FILE__, errno, strerror(errno)); exit(1); } while(0) - +#define FATAL do { \ + fprintf(stderr, "Error at line %d, file %s (%d) [%s]\n", \ + __LINE__, __FILE__, errno, strerror(errno)); \ + exit(1); \ + } while(0) + #define MAP_SIZE 4096UL #define MAP_MASK (MAP_SIZE - 1) int devmem2(int debug, off_t target, int access_type, unsigned long *read_result, unsigned long *writeval) { - int fd; - void *map_base, *virt_addr; + int fd; + void *map_base, *virt_addr; + + if((fd = open("/dev/mem", O_RDWR | O_SYNC)) == -1) FATAL; + if (debug) + printf("/dev/mem opened.\n"); + fflush(stdout); + + /* Map one page */ + map_base = mmap(0, MAP_SIZE, PROT_READ | PROT_WRITE, MAP_SHARED, fd, + target & ~MAP_MASK); + if(map_base == (void *) -1) FATAL; + if (debug) + printf("Memory mapped at address %p.\n", map_base); + fflush(stdout); - if((fd = open("/dev/mem", O_RDWR | O_SYNC)) == -1) FATAL; - if (debug) - printf("/dev/mem opened.\n"); - fflush(stdout); - - /* Map one page */ - map_base = mmap(0, MAP_SIZE, PROT_READ | PROT_WRITE, MAP_SHARED, fd, target & ~MAP_MASK); - if(map_base == (void *) -1) FATAL; - if (debug) - printf("Memory mapped at address %p.\n", map_base); - fflush(stdout); - - virt_addr = map_base + (target & MAP_MASK); - switch(access_type) { + virt_addr = map_base + (target & MAP_MASK); + switch(access_type) { + case 'b': + *read_result = *((unsigned char *) virt_addr); + break; + case 'h': + *read_result = *((unsigned short *) virt_addr); + break; + case 'w': + *read_result = *((unsigned long *) virt_addr); + break; + default: + fprintf(stderr, "Illegal data type '%c'.\n", access_type); + exit(2); + } + if (debug) + printf("Value at address 0x%X (%p): 0x%X\n", target, virt_addr, + *read_result); + fflush(stdout); + + if(writeval != NULL) { + switch(access_type) { case 'b': + *((unsigned char *) virt_addr) = *writeval; *read_result = *((unsigned char *) virt_addr); break; case 'h': + *((unsigned short *) virt_addr) = *writeval; *read_result = *((unsigned short *) virt_addr); break; case 'w': + *((unsigned long *) virt_addr) = *writeval; *read_result = *((unsigned long *) virt_addr); break; - default: - fprintf(stderr, "Illegal data type '%c'.\n", access_type); - exit(2); - } - if (debug) - printf("Value at address 0x%X (%p): 0x%X\n", target, virt_addr, - *read_result); - fflush(stdout); - - if(writeval != NULL) { - switch(access_type) { - case 'b': - *((unsigned char *) virt_addr) = *writeval; - *read_result = *((unsigned char *) virt_addr); - break; - case 'h': - *((unsigned short *) virt_addr) = *writeval; - *read_result = *((unsigned short *) virt_addr); - break; - case 'w': - *((unsigned long *) virt_addr) = *writeval; - *read_result = *((unsigned long *) virt_addr); - break; } if (debug) - printf("Written 0x%X; readback 0x%X\n", *writeval, *read_result); + printf("Written 0x%X; readback 0x%X\n", *writeval, + *read_result); fflush(stdout); } - + if(munmap(map_base, MAP_SIZE) == -1) FATAL; - close(fd); - return 0; + close(fd); + return 0; } - |
