summaryrefslogtreecommitdiffstats
diff options
context:
space:
mode:
authorDenis 'GNUtoo' Carikli <GNUtoo@cyberdimension.org>2021-06-09 18:02:29 +0200
committerDenis 'GNUtoo' Carikli <GNUtoo@cyberdimension.org>2021-06-09 18:02:29 +0200
commit99f3de54e09fc5bd17301f97ca9a5efeb92870e4 (patch)
tree801f39e3c52aefe0dc403086122f453413423695
parent0730b267d1f0677c34ed640cac14761be9ffb21b (diff)
downloadexynos-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.c100
1 files changed, 52 insertions, 48 deletions
diff --git a/devmem2.c b/devmem2.c
index 967dbc2..aed6e52 100644
--- a/devmem2.c
+++ b/devmem2.c
@@ -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;
}
-