| 1 | /********************************************************************** | 
|---|
| 2 | * \file    io.h | 
|---|
| 3 | * \date    5 September 2012 | 
|---|
| 4 | * \author  Cesar Fuguet / Alain Greiner | 
|---|
| 5 | * | 
|---|
| 6 | * Utility functions to write or read memory mapped hardware registers | 
|---|
| 7 | *********************************************************************/ | 
|---|
| 8 |  | 
|---|
| 9 | #ifndef IO_H | 
|---|
| 10 | #define IO_H | 
|---|
| 11 |  | 
|---|
| 12 | #include <defs.h> | 
|---|
| 13 |  | 
|---|
| 14 | /********************************************************************** | 
|---|
| 15 | * Read an 32 bits memory mapped hardware register | 
|---|
| 16 | * with physical address extension to access cluster_io | 
|---|
| 17 | *********************************************************************/ | 
|---|
| 18 | static inline unsigned int ioread32(void * addr) | 
|---|
| 19 | { | 
|---|
| 20 | unsigned int value; | 
|---|
| 21 | unsigned int ext = CLUSTER_IO; | 
|---|
| 22 |  | 
|---|
| 23 | asm volatile( | 
|---|
| 24 | "mtc2  %2,    $24            \n"  /* PADDR_EXT <= cluster_io */ | 
|---|
| 25 | "lw    %0,    0(%1)          \n"  /* value <= *(ext\addr)    */ | 
|---|
| 26 | "mtc2  $0,    $24            \n"  /* PADDR_EXT <= 0          */ | 
|---|
| 27 | : "=r" (value) | 
|---|
| 28 | : "r" (addr), "r" (ext) | 
|---|
| 29 | : "memory" ); | 
|---|
| 30 |  | 
|---|
| 31 | return (volatile unsigned int)value; | 
|---|
| 32 | } | 
|---|
| 33 |  | 
|---|
| 34 | /********************************************************************** | 
|---|
| 35 | * Read an 16 bits memory mapped hardware register | 
|---|
| 36 | *********************************************************************/ | 
|---|
| 37 | static inline unsigned short ioread16(void * addr) | 
|---|
| 38 | { | 
|---|
| 39 | unsigned short value; | 
|---|
| 40 | unsigned int ext = CLUSTER_IO; | 
|---|
| 41 |  | 
|---|
| 42 | asm volatile( | 
|---|
| 43 | "mtc2  %2,    $24            \n"  /* PADDR_EXT <= cluster_io */ | 
|---|
| 44 | "lhu   %0,    0(%1)          \n"  /* value <= *(ext\addr)    */ | 
|---|
| 45 | "mtc2  $0,    $24            \n"  /* PADDR_EXT <= 0          */ | 
|---|
| 46 | : "=r" (value) | 
|---|
| 47 | : "r" (addr), "r" (ext) | 
|---|
| 48 | : "memory" ); | 
|---|
| 49 |  | 
|---|
| 50 | return (volatile unsigned short)value; | 
|---|
| 51 | } | 
|---|
| 52 |  | 
|---|
| 53 | /********************************************************************** | 
|---|
| 54 | * Read an 8 bits memory mapped hardware register | 
|---|
| 55 | *********************************************************************/ | 
|---|
| 56 | static inline unsigned char ioread8(void * addr) | 
|---|
| 57 | { | 
|---|
| 58 | unsigned char value; | 
|---|
| 59 | unsigned int ext = CLUSTER_IO; | 
|---|
| 60 |  | 
|---|
| 61 | asm volatile( | 
|---|
| 62 | "mtc2  %2,    $24            \n"  /* PADDR_EXT <= cluster_io */ | 
|---|
| 63 | "lbu   %0,    0(%1)          \n"  /* value <= *(ext\addr)    */ | 
|---|
| 64 | "mtc2  $0,    $24            \n"  /* PADDR_EXT <= 0          */ | 
|---|
| 65 | : "=r" (value) | 
|---|
| 66 | : "r" (addr), "r" (ext) | 
|---|
| 67 | : "memory" ); | 
|---|
| 68 |  | 
|---|
| 69 | return (volatile unsigned char)value; | 
|---|
| 70 | } | 
|---|
| 71 |  | 
|---|
| 72 | /********************************************************************** | 
|---|
| 73 | * Write an 32 bits memory mapped hardware register | 
|---|
| 74 | * with physical address extension to access cluster_io | 
|---|
| 75 | *********************************************************************/ | 
|---|
| 76 | static inline void iowrite32(void * addr, unsigned int value) | 
|---|
| 77 | { | 
|---|
| 78 | unsigned int ext = CLUSTER_IO; | 
|---|
| 79 |  | 
|---|
| 80 | asm volatile( | 
|---|
| 81 | "mtc2  %2,    $24            \n"  /* PADDR_EXT <= cluster_io */ | 
|---|
| 82 | "sw    %0,    0(%1)          \n"  /* *(ext\addr) <= value    */ | 
|---|
| 83 | "mtc2  $0,    $24            \n"  /* PADDR_EXT <= 0          */ | 
|---|
| 84 | "sync                        \n"  /* sync barrier            */ | 
|---|
| 85 | : | 
|---|
| 86 | : "r" (value), "r" (addr), "r" (ext) | 
|---|
| 87 | : "memory" ); | 
|---|
| 88 | } | 
|---|
| 89 |  | 
|---|
| 90 | /********************************************************************** | 
|---|
| 91 | * Write an 16 bits memory mapped hardware register | 
|---|
| 92 | *********************************************************************/ | 
|---|
| 93 | static inline void iowrite16(void * addr, unsigned short value) | 
|---|
| 94 | { | 
|---|
| 95 | unsigned int ext = CLUSTER_IO; | 
|---|
| 96 |  | 
|---|
| 97 | asm volatile( | 
|---|
| 98 | "mtc2  %2,    $24            \n"  /* PADDR_EXT <= cluster_io */ | 
|---|
| 99 | "sh    %0,    0(%1)          \n"  /* *(ext\addr) <= value    */ | 
|---|
| 100 | "mtc2  $0,    $24            \n"  /* PADDR_EXT <= 0          */ | 
|---|
| 101 | "sync                        \n"  /* sync barrier            */ | 
|---|
| 102 | : | 
|---|
| 103 | : "r" (value), "r" (addr), "r" (ext) | 
|---|
| 104 | : "memory" ); | 
|---|
| 105 | } | 
|---|
| 106 |  | 
|---|
| 107 | /********************************************************************** | 
|---|
| 108 | * Write an 8 bits memory mapped hardware register | 
|---|
| 109 | *********************************************************************/ | 
|---|
| 110 | static inline void iowrite8(void * addr, unsigned char value) | 
|---|
| 111 | { | 
|---|
| 112 | unsigned int ext = CLUSTER_IO; | 
|---|
| 113 |  | 
|---|
| 114 | asm volatile( | 
|---|
| 115 | "mtc2  %2,    $24            \n"  /* PADDR_EXT <= cluster_io */ | 
|---|
| 116 | "sb    %0,    0(%1)          \n"  /* *(ext\addr) <= value    */ | 
|---|
| 117 | "mtc2  $0,    $24            \n"  /* PADDR_EXT <= 0          */ | 
|---|
| 118 | "sync                        \n"  /* sync barrier            */ | 
|---|
| 119 | : | 
|---|
| 120 | : "r" (value), "r" (addr), "r" (ext) | 
|---|
| 121 | : "memory" ); | 
|---|
| 122 | } | 
|---|
| 123 |  | 
|---|
| 124 | #endif | 
|---|
| 125 |  | 
|---|
| 126 | // vim: tabstop=4 : softtabstop=4 : shiftwidth=4 : expandtab | 
|---|