Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 1 | /**************************************************************************** |
| 2 | |
| 3 | (c) SYSTEC electronic GmbH, D-07973 Greiz, August-Bebel-Str. 29 |
| 4 | www.systec-electronic.com |
| 5 | |
| 6 | Project: openPOWERLINK |
| 7 | |
| 8 | Description: Abstract Memory Interface for x86 compatible |
| 9 | |
| 10 | License: |
| 11 | |
| 12 | Redistribution and use in source and binary forms, with or without |
| 13 | modification, are permitted provided that the following conditions |
| 14 | are met: |
| 15 | |
| 16 | 1. Redistributions of source code must retain the above copyright |
| 17 | notice, this list of conditions and the following disclaimer. |
| 18 | |
| 19 | 2. Redistributions in binary form must reproduce the above copyright |
| 20 | notice, this list of conditions and the following disclaimer in the |
| 21 | documentation and/or other materials provided with the distribution. |
| 22 | |
| 23 | 3. Neither the name of SYSTEC electronic GmbH nor the names of its |
| 24 | contributors may be used to endorse or promote products derived |
| 25 | from this software without prior written permission. For written |
| 26 | permission, please contact info@systec-electronic.com. |
| 27 | |
| 28 | THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS |
| 29 | "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT |
| 30 | LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS |
| 31 | FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE |
| 32 | COPYRIGHT HOLDERS OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, |
| 33 | INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, |
| 34 | BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; |
| 35 | LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER |
| 36 | CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT |
| 37 | LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN |
| 38 | ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE |
| 39 | POSSIBILITY OF SUCH DAMAGE. |
| 40 | |
| 41 | Severability Clause: |
| 42 | |
| 43 | If a provision of this License is or becomes illegal, invalid or |
| 44 | unenforceable in any jurisdiction, that shall not affect: |
| 45 | 1. the validity or enforceability in that jurisdiction of any other |
| 46 | provision of this License; or |
| 47 | 2. the validity or enforceability in other jurisdictions of that or |
| 48 | any other provision of this License. |
| 49 | |
| 50 | ------------------------------------------------------------------------- |
| 51 | |
| 52 | $RCSfile: amix86.c,v $ |
| 53 | |
| 54 | $Author: D.Krueger $ |
| 55 | |
| 56 | $Revision: 1.3 $ $Date: 2008/04/17 21:36:32 $ |
| 57 | |
| 58 | $State: Exp $ |
| 59 | |
| 60 | Build Environment: |
| 61 | ... |
| 62 | |
| 63 | ------------------------------------------------------------------------- |
| 64 | |
| 65 | Revision History: |
| 66 | |
| 67 | r.s.: first implemetation |
| 68 | |
| 69 | 2006-06-13 d.k.: duplicate functions for little endian and big endian |
| 70 | |
| 71 | ****************************************************************************/ |
| 72 | |
| 73 | //#include "global.h" |
| 74 | //#include "EplAmi.h" |
| 75 | #include "EplInc.h" |
| 76 | |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 77 | //--------------------------------------------------------------------------- |
| 78 | // typedef |
| 79 | //--------------------------------------------------------------------------- |
| 80 | |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 81 | typedef struct { |
Greg Kroah-Hartman | dcf5371 | 2009-03-23 12:57:39 -0700 | [diff] [blame] | 82 | u16 m_wWord; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 83 | |
| 84 | } twStruct; |
| 85 | |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 86 | typedef struct { |
Greg Kroah-Hartman | d539cfb | 2009-03-23 12:51:37 -0700 | [diff] [blame] | 87 | u32 m_dwDword; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 88 | |
| 89 | } tdwStruct; |
| 90 | |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 91 | typedef struct { |
Greg Kroah-Hartman | a5c30d9 | 2009-03-23 12:43:05 -0700 | [diff] [blame] | 92 | u64 m_qwQword; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 93 | |
| 94 | } tqwStruct; |
| 95 | |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 96 | //=========================================================================// |
| 97 | // // |
| 98 | // P U B L I C F U N C T I O N S // |
| 99 | // // |
| 100 | //=========================================================================// |
| 101 | |
| 102 | //--------------------------------------------------------------------------- |
| 103 | // |
| 104 | // Function: AmiSetXXXToBe() |
| 105 | // |
| 106 | // Description: writes the specified value to the absolute address in |
| 107 | // big endian |
| 108 | // |
| 109 | // Parameters: pAddr_p = absolute address |
| 110 | // xXXXVal_p = value |
| 111 | // |
| 112 | // Returns: (none) |
| 113 | // |
| 114 | // State: |
| 115 | // |
| 116 | //--------------------------------------------------------------------------- |
| 117 | |
Greg Kroah-Hartman | 2ed53cf | 2009-03-23 12:36:38 -0700 | [diff] [blame] | 118 | //------------< write u8 in big endian >-------------------------- |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 119 | /* |
Greg Kroah-Hartman | 2ed53cf | 2009-03-23 12:36:38 -0700 | [diff] [blame] | 120 | void AmiSetByteToBe (void *pAddr_p, u8 bByteVal_p) |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 121 | { |
| 122 | |
Greg Kroah-Hartman | 2ed53cf | 2009-03-23 12:36:38 -0700 | [diff] [blame] | 123 | *(u8 *)pAddr_p = bByteVal_p; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 124 | |
| 125 | } |
| 126 | */ |
| 127 | |
Greg Kroah-Hartman | dcf5371 | 2009-03-23 12:57:39 -0700 | [diff] [blame] | 128 | //------------< write u16 in big endian >-------------------------- |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 129 | |
Greg Kroah-Hartman | dcf5371 | 2009-03-23 12:57:39 -0700 | [diff] [blame] | 130 | void AmiSetWordToBe(void * pAddr_p, u16 wWordVal_p) |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 131 | { |
Greg Kroah-Hartman | f15a88f | 2009-03-23 11:44:31 -0700 | [diff] [blame] | 132 | twStruct *pwStruct; |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 133 | twStruct wValue; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 134 | |
Greg Kroah-Hartman | dcf5371 | 2009-03-23 12:57:39 -0700 | [diff] [blame] | 135 | wValue.m_wWord = (u16) ((wWordVal_p & 0x00FF) << 8); //LSB to MSB |
| 136 | wValue.m_wWord |= (u16) ((wWordVal_p & 0xFF00) >> 8); //MSB to LSB |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 137 | |
Greg Kroah-Hartman | f15a88f | 2009-03-23 11:44:31 -0700 | [diff] [blame] | 138 | pwStruct = (twStruct *) pAddr_p; |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 139 | pwStruct->m_wWord = wValue.m_wWord; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 140 | |
| 141 | } |
| 142 | |
Greg Kroah-Hartman | d539cfb | 2009-03-23 12:51:37 -0700 | [diff] [blame] | 143 | //------------< write u32 in big endian >------------------------- |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 144 | |
Greg Kroah-Hartman | d539cfb | 2009-03-23 12:51:37 -0700 | [diff] [blame] | 145 | void AmiSetDwordToBe(void *pAddr_p, u32 dwDwordVal_p) |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 146 | { |
Greg Kroah-Hartman | f15a88f | 2009-03-23 11:44:31 -0700 | [diff] [blame] | 147 | tdwStruct *pdwStruct; |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 148 | tdwStruct dwValue; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 149 | |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 150 | dwValue.m_dwDword = ((dwDwordVal_p & 0x000000FF) << 24); //LSB to MSB |
| 151 | dwValue.m_dwDword |= ((dwDwordVal_p & 0x0000FF00) << 8); |
| 152 | dwValue.m_dwDword |= ((dwDwordVal_p & 0x00FF0000) >> 8); |
| 153 | dwValue.m_dwDword |= ((dwDwordVal_p & 0xFF000000) >> 24); //MSB to LSB |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 154 | |
Greg Kroah-Hartman | f15a88f | 2009-03-23 11:44:31 -0700 | [diff] [blame] | 155 | pdwStruct = (tdwStruct *) pAddr_p; |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 156 | pdwStruct->m_dwDword = dwValue.m_dwDword; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 157 | |
| 158 | } |
| 159 | |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 160 | //--------------------------------------------------------------------------- |
| 161 | // |
| 162 | // Function: AmiSetXXXToLe() |
| 163 | // |
| 164 | // Description: writes the specified value to the absolute address in |
| 165 | // little endian |
| 166 | // |
| 167 | // Parameters: pAddr_p = absolute address |
| 168 | // xXXXVal_p = value |
| 169 | // |
| 170 | // Returns: (none) |
| 171 | // |
| 172 | // State: |
| 173 | // |
| 174 | //--------------------------------------------------------------------------- |
| 175 | |
Greg Kroah-Hartman | 2ed53cf | 2009-03-23 12:36:38 -0700 | [diff] [blame] | 176 | //------------< write u8 in little endian >-------------------------- |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 177 | /* |
Greg Kroah-Hartman | 2ed53cf | 2009-03-23 12:36:38 -0700 | [diff] [blame] | 178 | void AmiSetByteToLe (void *pAddr_p, u8 bByteVal_p) |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 179 | { |
| 180 | |
Greg Kroah-Hartman | 2ed53cf | 2009-03-23 12:36:38 -0700 | [diff] [blame] | 181 | *(u8 *)pAddr_p = bByteVal_p; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 182 | |
| 183 | } |
| 184 | */ |
| 185 | |
Greg Kroah-Hartman | dcf5371 | 2009-03-23 12:57:39 -0700 | [diff] [blame] | 186 | //------------< write u16 in little endian >-------------------------- |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 187 | |
Greg Kroah-Hartman | dcf5371 | 2009-03-23 12:57:39 -0700 | [diff] [blame] | 188 | void AmiSetWordToLe(void *pAddr_p, u16 wWordVal_p) |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 189 | { |
Greg Kroah-Hartman | f15a88f | 2009-03-23 11:44:31 -0700 | [diff] [blame] | 190 | twStruct *pwStruct; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 191 | |
Greg Kroah-Hartman | f15a88f | 2009-03-23 11:44:31 -0700 | [diff] [blame] | 192 | pwStruct = (twStruct *) pAddr_p; |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 193 | pwStruct->m_wWord = wWordVal_p; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 194 | |
| 195 | } |
| 196 | |
Greg Kroah-Hartman | d539cfb | 2009-03-23 12:51:37 -0700 | [diff] [blame] | 197 | //------------< write u32 in little endian >------------------------- |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 198 | |
Greg Kroah-Hartman | d539cfb | 2009-03-23 12:51:37 -0700 | [diff] [blame] | 199 | void AmiSetDwordToLe(void *pAddr_p, u32 dwDwordVal_p) |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 200 | { |
Greg Kroah-Hartman | f15a88f | 2009-03-23 11:44:31 -0700 | [diff] [blame] | 201 | tdwStruct *pdwStruct; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 202 | |
Greg Kroah-Hartman | f15a88f | 2009-03-23 11:44:31 -0700 | [diff] [blame] | 203 | pdwStruct = (tdwStruct *) pAddr_p; |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 204 | pdwStruct->m_dwDword = dwDwordVal_p; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 205 | |
| 206 | } |
| 207 | |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 208 | //--------------------------------------------------------------------------- |
| 209 | // |
| 210 | // Function: AmiGetXXXFromBe() |
| 211 | // |
| 212 | // Description: reads the specified value from the absolute address in |
| 213 | // big endian |
| 214 | // |
| 215 | // Parameters: pAddr_p = absolute address |
| 216 | // |
| 217 | // Returns: XXX = value |
| 218 | // |
| 219 | // State: |
| 220 | // |
| 221 | //--------------------------------------------------------------------------- |
| 222 | |
Greg Kroah-Hartman | 2ed53cf | 2009-03-23 12:36:38 -0700 | [diff] [blame] | 223 | //------------< read u8 in big endian >--------------------------- |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 224 | /* |
Greg Kroah-Hartman | 2ed53cf | 2009-03-23 12:36:38 -0700 | [diff] [blame] | 225 | u8 AmiGetByteFromBe (void *pAddr_p) |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 226 | { |
| 227 | |
Greg Kroah-Hartman | 2ed53cf | 2009-03-23 12:36:38 -0700 | [diff] [blame] | 228 | return ( *(u8 *)pAddr_p ); |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 229 | |
| 230 | } |
| 231 | */ |
| 232 | |
Greg Kroah-Hartman | dcf5371 | 2009-03-23 12:57:39 -0700 | [diff] [blame] | 233 | //------------< read u16 in big endian >--------------------------- |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 234 | |
Greg Kroah-Hartman | dcf5371 | 2009-03-23 12:57:39 -0700 | [diff] [blame] | 235 | u16 AmiGetWordFromBe(void *pAddr_p) |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 236 | { |
Greg Kroah-Hartman | f15a88f | 2009-03-23 11:44:31 -0700 | [diff] [blame] | 237 | twStruct *pwStruct; |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 238 | twStruct wValue; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 239 | |
Greg Kroah-Hartman | f15a88f | 2009-03-23 11:44:31 -0700 | [diff] [blame] | 240 | pwStruct = (twStruct *) pAddr_p; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 241 | |
Greg Kroah-Hartman | dcf5371 | 2009-03-23 12:57:39 -0700 | [diff] [blame] | 242 | wValue.m_wWord = (u16) ((pwStruct->m_wWord & 0x00FF) << 8); //LSB to MSB |
| 243 | wValue.m_wWord |= (u16) ((pwStruct->m_wWord & 0xFF00) >> 8); //MSB to LSB |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 244 | |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 245 | return (wValue.m_wWord); |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 246 | |
| 247 | } |
| 248 | |
Greg Kroah-Hartman | d539cfb | 2009-03-23 12:51:37 -0700 | [diff] [blame] | 249 | //------------< read u32 in big endian >-------------------------- |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 250 | |
Greg Kroah-Hartman | d539cfb | 2009-03-23 12:51:37 -0700 | [diff] [blame] | 251 | u32 AmiGetDwordFromBe(void *pAddr_p) |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 252 | { |
Greg Kroah-Hartman | f15a88f | 2009-03-23 11:44:31 -0700 | [diff] [blame] | 253 | tdwStruct *pdwStruct; |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 254 | tdwStruct dwValue; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 255 | |
Greg Kroah-Hartman | f15a88f | 2009-03-23 11:44:31 -0700 | [diff] [blame] | 256 | pdwStruct = (tdwStruct *) pAddr_p; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 257 | |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 258 | dwValue.m_dwDword = ((pdwStruct->m_dwDword & 0x000000FF) << 24); //LSB to MSB |
| 259 | dwValue.m_dwDword |= ((pdwStruct->m_dwDword & 0x0000FF00) << 8); |
| 260 | dwValue.m_dwDword |= ((pdwStruct->m_dwDword & 0x00FF0000) >> 8); |
| 261 | dwValue.m_dwDword |= ((pdwStruct->m_dwDword & 0xFF000000) >> 24); //MSB to LSB |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 262 | |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 263 | return (dwValue.m_dwDword); |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 264 | |
| 265 | } |
| 266 | |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 267 | //--------------------------------------------------------------------------- |
| 268 | // |
| 269 | // Function: AmiGetXXXFromLe() |
| 270 | // |
| 271 | // Description: reads the specified value from the absolute address in |
| 272 | // little endian |
| 273 | // |
| 274 | // Parameters: pAddr_p = absolute address |
| 275 | // |
| 276 | // Returns: XXX = value |
| 277 | // |
| 278 | // State: |
| 279 | // |
| 280 | //--------------------------------------------------------------------------- |
| 281 | |
Greg Kroah-Hartman | 2ed53cf | 2009-03-23 12:36:38 -0700 | [diff] [blame] | 282 | //------------< read u8 in little endian >--------------------------- |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 283 | /* |
Greg Kroah-Hartman | 2ed53cf | 2009-03-23 12:36:38 -0700 | [diff] [blame] | 284 | u8 AmiGetByteFromLe (void *pAddr_p) |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 285 | { |
| 286 | |
Greg Kroah-Hartman | 2ed53cf | 2009-03-23 12:36:38 -0700 | [diff] [blame] | 287 | return ( *(u8 *)pAddr_p ); |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 288 | |
| 289 | } |
| 290 | */ |
| 291 | |
Greg Kroah-Hartman | dcf5371 | 2009-03-23 12:57:39 -0700 | [diff] [blame] | 292 | //------------< read u16 in little endian >--------------------------- |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 293 | |
Greg Kroah-Hartman | dcf5371 | 2009-03-23 12:57:39 -0700 | [diff] [blame] | 294 | u16 AmiGetWordFromLe(void *pAddr_p) |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 295 | { |
Greg Kroah-Hartman | f15a88f | 2009-03-23 11:44:31 -0700 | [diff] [blame] | 296 | twStruct *pwStruct; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 297 | |
Greg Kroah-Hartman | f15a88f | 2009-03-23 11:44:31 -0700 | [diff] [blame] | 298 | pwStruct = (twStruct *) pAddr_p; |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 299 | return (pwStruct->m_wWord); |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 300 | } |
| 301 | |
Greg Kroah-Hartman | d539cfb | 2009-03-23 12:51:37 -0700 | [diff] [blame] | 302 | //------------< read u32 in little endian >-------------------------- |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 303 | |
Greg Kroah-Hartman | d539cfb | 2009-03-23 12:51:37 -0700 | [diff] [blame] | 304 | u32 AmiGetDwordFromLe(void *pAddr_p) |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 305 | { |
Greg Kroah-Hartman | f15a88f | 2009-03-23 11:44:31 -0700 | [diff] [blame] | 306 | tdwStruct *pdwStruct; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 307 | |
Greg Kroah-Hartman | f15a88f | 2009-03-23 11:44:31 -0700 | [diff] [blame] | 308 | pdwStruct = (tdwStruct *) pAddr_p; |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 309 | return (pdwStruct->m_dwDword); |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 310 | } |
| 311 | |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 312 | //--------------------------------------------------------------------------- |
| 313 | // |
| 314 | // Function: AmiSetDword24ToBe() |
| 315 | // |
| 316 | // Description: sets a 24 bit value to a buffer in big endian |
| 317 | // |
| 318 | // Parameters: pAddr_p = pointer to destination buffer |
| 319 | // dwDwordVal_p = value to set |
| 320 | // |
| 321 | // Return: void |
| 322 | // |
| 323 | // State: not tested |
| 324 | // |
| 325 | //--------------------------------------------------------------------------- |
| 326 | |
Greg Kroah-Hartman | d539cfb | 2009-03-23 12:51:37 -0700 | [diff] [blame] | 327 | void AmiSetDword24ToBe(void *pAddr_p, u32 dwDwordVal_p) |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 328 | { |
Greg Kroah-Hartman | 2ed53cf | 2009-03-23 12:36:38 -0700 | [diff] [blame] | 329 | ((u8 *) pAddr_p)[0] = ((u8 *) & dwDwordVal_p)[2]; |
| 330 | ((u8 *) pAddr_p)[1] = ((u8 *) & dwDwordVal_p)[1]; |
| 331 | ((u8 *) pAddr_p)[2] = ((u8 *) & dwDwordVal_p)[0]; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 332 | } |
| 333 | |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 334 | //--------------------------------------------------------------------------- |
| 335 | // |
| 336 | // Function: AmiSetDword24ToLe() |
| 337 | // |
| 338 | // Description: sets a 24 bit value to a buffer in little endian |
| 339 | // |
| 340 | // Parameters: pAddr_p = pointer to destination buffer |
| 341 | // dwDwordVal_p = value to set |
| 342 | // |
| 343 | // Return: void |
| 344 | // |
| 345 | // State: not tested |
| 346 | // |
| 347 | //--------------------------------------------------------------------------- |
| 348 | |
Greg Kroah-Hartman | d539cfb | 2009-03-23 12:51:37 -0700 | [diff] [blame] | 349 | void AmiSetDword24ToLe(void *pAddr_p, u32 dwDwordVal_p) |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 350 | { |
Greg Kroah-Hartman | 2ed53cf | 2009-03-23 12:36:38 -0700 | [diff] [blame] | 351 | ((u8 *) pAddr_p)[0] = ((u8 *) & dwDwordVal_p)[0]; |
| 352 | ((u8 *) pAddr_p)[1] = ((u8 *) & dwDwordVal_p)[1]; |
| 353 | ((u8 *) pAddr_p)[2] = ((u8 *) & dwDwordVal_p)[2]; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 354 | } |
| 355 | |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 356 | //--------------------------------------------------------------------------- |
| 357 | // |
| 358 | // Function: AmiGetDword24FromBe() |
| 359 | // |
| 360 | // Description: reads a 24 bit value from a buffer in big endian |
| 361 | // |
| 362 | // Parameters: pAddr_p = pointer to source buffer |
| 363 | // |
Greg Kroah-Hartman | d539cfb | 2009-03-23 12:51:37 -0700 | [diff] [blame] | 364 | // Return: u32 = read value |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 365 | // |
| 366 | // State: not tested |
| 367 | // |
| 368 | //--------------------------------------------------------------------------- |
Greg Kroah-Hartman | d539cfb | 2009-03-23 12:51:37 -0700 | [diff] [blame] | 369 | u32 AmiGetDword24FromBe(void *pAddr_p) |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 370 | { |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 371 | tdwStruct dwStruct; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 372 | |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 373 | dwStruct.m_dwDword = AmiGetDwordFromBe(pAddr_p); |
| 374 | dwStruct.m_dwDword >>= 8; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 375 | |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 376 | return (dwStruct.m_dwDword); |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 377 | } |
| 378 | |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 379 | //--------------------------------------------------------------------------- |
| 380 | // |
| 381 | // Function: AmiGetDword24FromLe() |
| 382 | // |
| 383 | // Description: reads a 24 bit value from a buffer in little endian |
| 384 | // |
| 385 | // Parameters: pAddr_p = pointer to source buffer |
| 386 | // |
Greg Kroah-Hartman | d539cfb | 2009-03-23 12:51:37 -0700 | [diff] [blame] | 387 | // Return: u32 = read value |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 388 | // |
| 389 | // State: not tested |
| 390 | // |
| 391 | //--------------------------------------------------------------------------- |
Greg Kroah-Hartman | d539cfb | 2009-03-23 12:51:37 -0700 | [diff] [blame] | 392 | u32 AmiGetDword24FromLe(void *pAddr_p) |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 393 | { |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 394 | tdwStruct dwStruct; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 395 | |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 396 | dwStruct.m_dwDword = AmiGetDwordFromLe(pAddr_p); |
| 397 | dwStruct.m_dwDword &= 0x00FFFFFF; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 398 | |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 399 | return (dwStruct.m_dwDword); |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 400 | } |
| 401 | |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 402 | //#ifdef USE_VAR64 |
| 403 | |
| 404 | //--------------------------------------------------------------------------- |
| 405 | // |
| 406 | // Function: AmiSetQword64ToBe() |
| 407 | // |
| 408 | // Description: sets a 64 bit value to a buffer in big endian |
| 409 | // |
| 410 | // Parameters: pAddr_p = pointer to destination buffer |
| 411 | // qwQwordVal_p = quadruple word value |
| 412 | // |
| 413 | // Return: void |
| 414 | // |
| 415 | // State: not tested |
| 416 | // |
| 417 | //--------------------------------------------------------------------------- |
Greg Kroah-Hartman | a5c30d9 | 2009-03-23 12:43:05 -0700 | [diff] [blame] | 418 | void AmiSetQword64ToBe(void *pAddr_p, u64 qwQwordVal_p) |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 419 | { |
Greg Kroah-Hartman | 2ed53cf | 2009-03-23 12:36:38 -0700 | [diff] [blame] | 420 | ((u8 *) pAddr_p)[0] = ((u8 *) & qwQwordVal_p)[7]; |
| 421 | ((u8 *) pAddr_p)[1] = ((u8 *) & qwQwordVal_p)[6]; |
| 422 | ((u8 *) pAddr_p)[2] = ((u8 *) & qwQwordVal_p)[5]; |
| 423 | ((u8 *) pAddr_p)[3] = ((u8 *) & qwQwordVal_p)[4]; |
| 424 | ((u8 *) pAddr_p)[4] = ((u8 *) & qwQwordVal_p)[3]; |
| 425 | ((u8 *) pAddr_p)[5] = ((u8 *) & qwQwordVal_p)[2]; |
| 426 | ((u8 *) pAddr_p)[6] = ((u8 *) & qwQwordVal_p)[1]; |
| 427 | ((u8 *) pAddr_p)[7] = ((u8 *) & qwQwordVal_p)[0]; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 428 | } |
| 429 | |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 430 | //--------------------------------------------------------------------------- |
| 431 | // |
| 432 | // Function: AmiSetQword64ToLe() |
| 433 | // |
| 434 | // Description: sets a 64 bit value to a buffer in little endian |
| 435 | // |
| 436 | // Parameters: pAddr_p = pointer to destination buffer |
| 437 | // qwQwordVal_p = quadruple word value |
| 438 | // |
| 439 | // Return: void |
| 440 | // |
| 441 | // State: not tested |
| 442 | // |
| 443 | //--------------------------------------------------------------------------- |
Greg Kroah-Hartman | a5c30d9 | 2009-03-23 12:43:05 -0700 | [diff] [blame] | 444 | void AmiSetQword64ToLe(void *pAddr_p, u64 qwQwordVal_p) |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 445 | { |
Greg Kroah-Hartman | a5c30d9 | 2009-03-23 12:43:05 -0700 | [diff] [blame] | 446 | u64 *pqwDst; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 447 | |
Greg Kroah-Hartman | a5c30d9 | 2009-03-23 12:43:05 -0700 | [diff] [blame] | 448 | pqwDst = (u64 *) pAddr_p; |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 449 | *pqwDst = qwQwordVal_p; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 450 | } |
| 451 | |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 452 | //--------------------------------------------------------------------------- |
| 453 | // |
| 454 | // Function: AmiGetQword64FromBe() |
| 455 | // |
| 456 | // Description: reads a 64 bit value from a buffer in big endian |
| 457 | // |
| 458 | // Parameters: pAddr_p = pointer to source buffer |
| 459 | // |
| 460 | // Return: void |
| 461 | // |
| 462 | // State: not tested |
| 463 | // |
| 464 | //--------------------------------------------------------------------------- |
Greg Kroah-Hartman | a5c30d9 | 2009-03-23 12:43:05 -0700 | [diff] [blame] | 465 | u64 AmiGetQword64FromBe(void *pAddr_p) |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 466 | { |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 467 | tqwStruct qwStruct; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 468 | |
Greg Kroah-Hartman | 2ed53cf | 2009-03-23 12:36:38 -0700 | [diff] [blame] | 469 | ((u8 *) & qwStruct.m_qwQword)[0] = ((u8 *) pAddr_p)[7]; |
| 470 | ((u8 *) & qwStruct.m_qwQword)[1] = ((u8 *) pAddr_p)[6]; |
| 471 | ((u8 *) & qwStruct.m_qwQword)[2] = ((u8 *) pAddr_p)[5]; |
| 472 | ((u8 *) & qwStruct.m_qwQword)[3] = ((u8 *) pAddr_p)[4]; |
| 473 | ((u8 *) & qwStruct.m_qwQword)[4] = ((u8 *) pAddr_p)[3]; |
| 474 | ((u8 *) & qwStruct.m_qwQword)[5] = ((u8 *) pAddr_p)[2]; |
| 475 | ((u8 *) & qwStruct.m_qwQword)[6] = ((u8 *) pAddr_p)[1]; |
| 476 | ((u8 *) & qwStruct.m_qwQword)[7] = ((u8 *) pAddr_p)[0]; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 477 | |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 478 | return (qwStruct.m_qwQword); |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 479 | } |
| 480 | |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 481 | //--------------------------------------------------------------------------- |
| 482 | // |
| 483 | // Function: AmiGetQword64FromLe() |
| 484 | // |
| 485 | // Description: reads a 64 bit value from a buffer in little endian |
| 486 | // |
| 487 | // Parameters: pAddr_p = pointer to source buffer |
| 488 | // |
| 489 | // Return: void |
| 490 | // |
| 491 | // State: not tested |
| 492 | // |
| 493 | //--------------------------------------------------------------------------- |
Greg Kroah-Hartman | a5c30d9 | 2009-03-23 12:43:05 -0700 | [diff] [blame] | 494 | u64 AmiGetQword64FromLe(void *pAddr_p) |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 495 | { |
Greg Kroah-Hartman | f15a88f | 2009-03-23 11:44:31 -0700 | [diff] [blame] | 496 | tqwStruct *pqwStruct; |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 497 | tqwStruct qwStruct; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 498 | |
Greg Kroah-Hartman | f15a88f | 2009-03-23 11:44:31 -0700 | [diff] [blame] | 499 | pqwStruct = (tqwStruct *) pAddr_p; |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 500 | qwStruct.m_qwQword = pqwStruct->m_qwQword; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 501 | |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 502 | return (qwStruct.m_qwQword); |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 503 | } |
| 504 | |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 505 | //--------------------------------------------------------------------------- |
| 506 | // |
| 507 | // Function: AmiSetQword40ToBe() |
| 508 | // |
| 509 | // Description: sets a 40 bit value to a buffer in big endian |
| 510 | // |
| 511 | // Parameters: pAddr_p = pointer to destination buffer |
| 512 | // qwQwordVal_p = quadruple word value |
| 513 | // |
| 514 | // Return: void |
| 515 | // |
| 516 | // State: not tested |
| 517 | // |
| 518 | //--------------------------------------------------------------------------- |
| 519 | |
Greg Kroah-Hartman | a5c30d9 | 2009-03-23 12:43:05 -0700 | [diff] [blame] | 520 | void AmiSetQword40ToBe(void *pAddr_p, u64 qwQwordVal_p) |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 521 | { |
| 522 | |
Greg Kroah-Hartman | 2ed53cf | 2009-03-23 12:36:38 -0700 | [diff] [blame] | 523 | ((u8 *) pAddr_p)[0] = ((u8 *) & qwQwordVal_p)[4]; |
| 524 | ((u8 *) pAddr_p)[1] = ((u8 *) & qwQwordVal_p)[3]; |
| 525 | ((u8 *) pAddr_p)[2] = ((u8 *) & qwQwordVal_p)[2]; |
| 526 | ((u8 *) pAddr_p)[3] = ((u8 *) & qwQwordVal_p)[1]; |
| 527 | ((u8 *) pAddr_p)[4] = ((u8 *) & qwQwordVal_p)[0]; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 528 | |
| 529 | } |
| 530 | |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 531 | //--------------------------------------------------------------------------- |
| 532 | // |
| 533 | // Function: AmiSetQword40ToLe() |
| 534 | // |
| 535 | // Description: sets a 40 bit value to a buffer in little endian |
| 536 | // |
| 537 | // Parameters: pAddr_p = pointer to destination buffer |
| 538 | // qwQwordVal_p = quadruple word value |
| 539 | // |
| 540 | // Return: void |
| 541 | // |
| 542 | // State: not tested |
| 543 | // |
| 544 | //--------------------------------------------------------------------------- |
| 545 | |
Greg Kroah-Hartman | a5c30d9 | 2009-03-23 12:43:05 -0700 | [diff] [blame] | 546 | void AmiSetQword40ToLe(void *pAddr_p, u64 qwQwordVal_p) |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 547 | { |
| 548 | |
Greg Kroah-Hartman | d539cfb | 2009-03-23 12:51:37 -0700 | [diff] [blame] | 549 | ((u32 *) pAddr_p)[0] = ((u32 *) & qwQwordVal_p)[0]; |
Greg Kroah-Hartman | 2ed53cf | 2009-03-23 12:36:38 -0700 | [diff] [blame] | 550 | ((u8 *) pAddr_p)[4] = ((u8 *) & qwQwordVal_p)[4]; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 551 | |
| 552 | } |
| 553 | |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 554 | //--------------------------------------------------------------------------- |
| 555 | // |
| 556 | // Function: AmiGetQword40FromBe() |
| 557 | // |
| 558 | // Description: reads a 40 bit value from a buffer in big endian |
| 559 | // |
| 560 | // Parameters: pAddr_p = pointer to source buffer |
| 561 | // |
Greg Kroah-Hartman | a5c30d9 | 2009-03-23 12:43:05 -0700 | [diff] [blame] | 562 | // Return: u64 |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 563 | // |
| 564 | // State: not tested |
| 565 | // |
| 566 | //--------------------------------------------------------------------------- |
| 567 | |
Greg Kroah-Hartman | a5c30d9 | 2009-03-23 12:43:05 -0700 | [diff] [blame] | 568 | u64 AmiGetQword40FromBe(void *pAddr_p) |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 569 | { |
| 570 | |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 571 | tqwStruct qwStruct; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 572 | |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 573 | qwStruct.m_qwQword = AmiGetQword64FromBe(pAddr_p); |
| 574 | qwStruct.m_qwQword >>= 24; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 575 | |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 576 | return (qwStruct.m_qwQword); |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 577 | |
| 578 | } |
| 579 | |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 580 | //--------------------------------------------------------------------------- |
| 581 | // |
| 582 | // Function: AmiGetQword40FromLe() |
| 583 | // |
| 584 | // Description: reads a 40 bit value from a buffer in little endian |
| 585 | // |
| 586 | // Parameters: pAddr_p = pointer to source buffer |
| 587 | // |
Greg Kroah-Hartman | a5c30d9 | 2009-03-23 12:43:05 -0700 | [diff] [blame] | 588 | // Return: u64 |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 589 | // |
| 590 | // State: not tested |
| 591 | // |
| 592 | //--------------------------------------------------------------------------- |
| 593 | |
Greg Kroah-Hartman | a5c30d9 | 2009-03-23 12:43:05 -0700 | [diff] [blame] | 594 | u64 AmiGetQword40FromLe(void *pAddr_p) |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 595 | { |
| 596 | |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 597 | tqwStruct qwStruct; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 598 | |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 599 | qwStruct.m_qwQword = AmiGetQword64FromLe(pAddr_p); |
| 600 | qwStruct.m_qwQword &= 0x000000FFFFFFFFFFLL; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 601 | |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 602 | return (qwStruct.m_qwQword); |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 603 | |
| 604 | } |
| 605 | |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 606 | //--------------------------------------------------------------------------- |
| 607 | // |
| 608 | // Function: AmiSetQword48ToBe() |
| 609 | // |
| 610 | // Description: sets a 48 bit value to a buffer in big endian |
| 611 | // |
| 612 | // Parameters: pAddr_p = pointer to destination buffer |
| 613 | // qwQwordVal_p = quadruple word value |
| 614 | // |
| 615 | // Return: void |
| 616 | // |
| 617 | // State: not tested |
| 618 | // |
| 619 | //--------------------------------------------------------------------------- |
| 620 | |
Greg Kroah-Hartman | a5c30d9 | 2009-03-23 12:43:05 -0700 | [diff] [blame] | 621 | void AmiSetQword48ToBe(void *pAddr_p, u64 qwQwordVal_p) |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 622 | { |
| 623 | |
Greg Kroah-Hartman | 2ed53cf | 2009-03-23 12:36:38 -0700 | [diff] [blame] | 624 | ((u8 *) pAddr_p)[0] = ((u8 *) & qwQwordVal_p)[5]; |
| 625 | ((u8 *) pAddr_p)[1] = ((u8 *) & qwQwordVal_p)[4]; |
| 626 | ((u8 *) pAddr_p)[2] = ((u8 *) & qwQwordVal_p)[3]; |
| 627 | ((u8 *) pAddr_p)[3] = ((u8 *) & qwQwordVal_p)[2]; |
| 628 | ((u8 *) pAddr_p)[4] = ((u8 *) & qwQwordVal_p)[1]; |
| 629 | ((u8 *) pAddr_p)[5] = ((u8 *) & qwQwordVal_p)[0]; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 630 | |
| 631 | } |
| 632 | |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 633 | //--------------------------------------------------------------------------- |
| 634 | // |
| 635 | // Function: AmiSetQword48ToLe() |
| 636 | // |
| 637 | // Description: sets a 48 bit value to a buffer in little endian |
| 638 | // |
| 639 | // Parameters: pAddr_p = pointer to destination buffer |
| 640 | // qwQwordVal_p = quadruple word value |
| 641 | // |
| 642 | // Return: void |
| 643 | // |
| 644 | // State: not tested |
| 645 | // |
| 646 | //--------------------------------------------------------------------------- |
| 647 | |
Greg Kroah-Hartman | a5c30d9 | 2009-03-23 12:43:05 -0700 | [diff] [blame] | 648 | void AmiSetQword48ToLe(void *pAddr_p, u64 qwQwordVal_p) |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 649 | { |
| 650 | |
Greg Kroah-Hartman | d539cfb | 2009-03-23 12:51:37 -0700 | [diff] [blame] | 651 | ((u32 *) pAddr_p)[0] = ((u32 *) & qwQwordVal_p)[0]; |
Greg Kroah-Hartman | dcf5371 | 2009-03-23 12:57:39 -0700 | [diff] [blame] | 652 | ((u16 *) pAddr_p)[2] = ((u16 *) & qwQwordVal_p)[2]; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 653 | |
| 654 | } |
| 655 | |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 656 | //--------------------------------------------------------------------------- |
| 657 | // |
| 658 | // Function: AmiGetQword48FromBe() |
| 659 | // |
| 660 | // Description: reads a 48 bit value from a buffer in big endian |
| 661 | // |
| 662 | // Parameters: pAddr_p = pointer to source buffer |
| 663 | // |
Greg Kroah-Hartman | a5c30d9 | 2009-03-23 12:43:05 -0700 | [diff] [blame] | 664 | // Return: u64 |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 665 | // |
| 666 | // State: not tested |
| 667 | // |
| 668 | //--------------------------------------------------------------------------- |
| 669 | |
Greg Kroah-Hartman | a5c30d9 | 2009-03-23 12:43:05 -0700 | [diff] [blame] | 670 | u64 AmiGetQword48FromBe(void *pAddr_p) |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 671 | { |
| 672 | |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 673 | tqwStruct qwStruct; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 674 | |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 675 | qwStruct.m_qwQword = AmiGetQword64FromBe(pAddr_p); |
| 676 | qwStruct.m_qwQword >>= 16; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 677 | |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 678 | return (qwStruct.m_qwQword); |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 679 | |
| 680 | } |
| 681 | |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 682 | //--------------------------------------------------------------------------- |
| 683 | // |
| 684 | // Function: AmiGetQword48FromLe() |
| 685 | // |
| 686 | // Description: reads a 48 bit value from a buffer in little endian |
| 687 | // |
| 688 | // Parameters: pAddr_p = pointer to source buffer |
| 689 | // |
Greg Kroah-Hartman | a5c30d9 | 2009-03-23 12:43:05 -0700 | [diff] [blame] | 690 | // Return: u64 |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 691 | // |
| 692 | // State: not tested |
| 693 | // |
| 694 | //--------------------------------------------------------------------------- |
| 695 | |
Greg Kroah-Hartman | a5c30d9 | 2009-03-23 12:43:05 -0700 | [diff] [blame] | 696 | u64 AmiGetQword48FromLe(void *pAddr_p) |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 697 | { |
| 698 | |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 699 | tqwStruct qwStruct; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 700 | |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 701 | qwStruct.m_qwQword = AmiGetQword64FromLe(pAddr_p); |
| 702 | qwStruct.m_qwQword &= 0x0000FFFFFFFFFFFFLL; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 703 | |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 704 | return (qwStruct.m_qwQword); |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 705 | |
| 706 | } |
| 707 | |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 708 | //--------------------------------------------------------------------------- |
| 709 | // |
| 710 | // Function: AmiSetQword56ToBe() |
| 711 | // |
| 712 | // Description: sets a 56 bit value to a buffer in big endian |
| 713 | // |
| 714 | // Parameters: pAddr_p = pointer to destination buffer |
| 715 | // qwQwordVal_p = quadruple word value |
| 716 | // |
| 717 | // Return: void |
| 718 | // |
| 719 | // State: not tested |
| 720 | // |
| 721 | //--------------------------------------------------------------------------- |
| 722 | |
Greg Kroah-Hartman | a5c30d9 | 2009-03-23 12:43:05 -0700 | [diff] [blame] | 723 | void AmiSetQword56ToBe(void *pAddr_p, u64 qwQwordVal_p) |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 724 | { |
| 725 | |
Greg Kroah-Hartman | 2ed53cf | 2009-03-23 12:36:38 -0700 | [diff] [blame] | 726 | ((u8 *) pAddr_p)[0] = ((u8 *) & qwQwordVal_p)[6]; |
| 727 | ((u8 *) pAddr_p)[1] = ((u8 *) & qwQwordVal_p)[5]; |
| 728 | ((u8 *) pAddr_p)[2] = ((u8 *) & qwQwordVal_p)[4]; |
| 729 | ((u8 *) pAddr_p)[3] = ((u8 *) & qwQwordVal_p)[3]; |
| 730 | ((u8 *) pAddr_p)[4] = ((u8 *) & qwQwordVal_p)[2]; |
| 731 | ((u8 *) pAddr_p)[5] = ((u8 *) & qwQwordVal_p)[1]; |
| 732 | ((u8 *) pAddr_p)[6] = ((u8 *) & qwQwordVal_p)[0]; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 733 | |
| 734 | } |
| 735 | |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 736 | //--------------------------------------------------------------------------- |
| 737 | // |
| 738 | // Function: AmiSetQword56ToLe() |
| 739 | // |
| 740 | // Description: sets a 56 bit value to a buffer in little endian |
| 741 | // |
| 742 | // Parameters: pAddr_p = pointer to destination buffer |
| 743 | // qwQwordVal_p = quadruple word value |
| 744 | // |
| 745 | // Return: void |
| 746 | // |
| 747 | // State: not tested |
| 748 | // |
| 749 | //--------------------------------------------------------------------------- |
| 750 | |
Greg Kroah-Hartman | a5c30d9 | 2009-03-23 12:43:05 -0700 | [diff] [blame] | 751 | void AmiSetQword56ToLe(void *pAddr_p, u64 qwQwordVal_p) |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 752 | { |
| 753 | |
Greg Kroah-Hartman | d539cfb | 2009-03-23 12:51:37 -0700 | [diff] [blame] | 754 | ((u32 *) pAddr_p)[0] = ((u32 *) & qwQwordVal_p)[0]; |
Greg Kroah-Hartman | dcf5371 | 2009-03-23 12:57:39 -0700 | [diff] [blame] | 755 | ((u16 *) pAddr_p)[2] = ((u16 *) & qwQwordVal_p)[2]; |
Greg Kroah-Hartman | 2ed53cf | 2009-03-23 12:36:38 -0700 | [diff] [blame] | 756 | ((u8 *) pAddr_p)[6] = ((u8 *) & qwQwordVal_p)[6]; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 757 | |
| 758 | } |
| 759 | |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 760 | //--------------------------------------------------------------------------- |
| 761 | // |
| 762 | // Function: AmiGetQword56FromBe() |
| 763 | // |
| 764 | // Description: reads a 56 bit value from a buffer in big endian |
| 765 | // |
| 766 | // Parameters: pAddr_p = pointer to source buffer |
| 767 | // |
Greg Kroah-Hartman | a5c30d9 | 2009-03-23 12:43:05 -0700 | [diff] [blame] | 768 | // Return: u64 |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 769 | // |
| 770 | // State: not tested |
| 771 | // |
| 772 | //--------------------------------------------------------------------------- |
| 773 | |
Greg Kroah-Hartman | a5c30d9 | 2009-03-23 12:43:05 -0700 | [diff] [blame] | 774 | u64 AmiGetQword56FromBe(void *pAddr_p) |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 775 | { |
| 776 | |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 777 | tqwStruct qwStruct; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 778 | |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 779 | qwStruct.m_qwQword = AmiGetQword64FromBe(pAddr_p); |
| 780 | qwStruct.m_qwQword >>= 8; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 781 | |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 782 | return (qwStruct.m_qwQword); |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 783 | |
| 784 | } |
| 785 | |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 786 | //--------------------------------------------------------------------------- |
| 787 | // |
| 788 | // Function: AmiGetQword56FromLe() |
| 789 | // |
| 790 | // Description: reads a 56 bit value from a buffer in little endian |
| 791 | // |
| 792 | // Parameters: pAddr_p = pointer to source buffer |
| 793 | // |
Greg Kroah-Hartman | a5c30d9 | 2009-03-23 12:43:05 -0700 | [diff] [blame] | 794 | // Return: u64 |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 795 | // |
| 796 | // State: not tested |
| 797 | // |
| 798 | //--------------------------------------------------------------------------- |
| 799 | |
Greg Kroah-Hartman | a5c30d9 | 2009-03-23 12:43:05 -0700 | [diff] [blame] | 800 | u64 AmiGetQword56FromLe(void *pAddr_p) |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 801 | { |
| 802 | |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 803 | tqwStruct qwStruct; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 804 | |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 805 | qwStruct.m_qwQword = AmiGetQword64FromLe(pAddr_p); |
| 806 | qwStruct.m_qwQword &= 0x00FFFFFFFFFFFFFFLL; |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 807 | |
Greg Kroah-Hartman | 833dfbe | 2008-12-19 17:11:52 -0800 | [diff] [blame] | 808 | return (qwStruct.m_qwQword); |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 809 | |
| 810 | } |
| 811 | |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 812 | //--------------------------------------------------------------------------- |
| 813 | // |
| 814 | // Function: AmiSetTimeOfDay() |
| 815 | // |
| 816 | // Description: sets a TIME_OF_DAY (CANopen) value to a buffer |
| 817 | // |
| 818 | // Parameters: pAddr_p = pointer to destination buffer |
| 819 | // pTimeOfDay_p = pointer to struct TIME_OF_DAY |
| 820 | // |
| 821 | // Return: void |
| 822 | // |
| 823 | // State: not tested |
| 824 | // |
| 825 | //--------------------------------------------------------------------------- |
| 826 | |
Greg Kroah-Hartman | f15a88f | 2009-03-23 11:44:31 -0700 | [diff] [blame] | 827 | void AmiSetTimeOfDay(void *pAddr_p, tTimeOfDay *pTimeOfDay_p) |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 828 | { |
| 829 | |
Greg Kroah-Hartman | 2ed53cf | 2009-03-23 12:36:38 -0700 | [diff] [blame] | 830 | AmiSetDwordToLe(((u8 *) pAddr_p), pTimeOfDay_p->m_dwMs & 0x0FFFFFFF); |
| 831 | AmiSetWordToLe(((u8 *) pAddr_p) + 4, pTimeOfDay_p->m_wDays); |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 832 | |
| 833 | } |
| 834 | |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 835 | //--------------------------------------------------------------------------- |
| 836 | // |
| 837 | // Function: AmiGetTimeOfDay() |
| 838 | // |
| 839 | // Description: reads a TIME_OF_DAY (CANopen) value from a buffer |
| 840 | // |
| 841 | // Parameters: pAddr_p = pointer to source buffer |
| 842 | // pTimeOfDay_p = pointer to struct TIME_OF_DAY |
| 843 | // |
| 844 | // Return: void |
| 845 | // |
| 846 | // State: not tested |
| 847 | // |
| 848 | //--------------------------------------------------------------------------- |
| 849 | |
Greg Kroah-Hartman | f15a88f | 2009-03-23 11:44:31 -0700 | [diff] [blame] | 850 | void AmiGetTimeOfDay(void *pAddr_p, tTimeOfDay *pTimeOfDay_p) |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 851 | { |
| 852 | |
Greg Kroah-Hartman | 2ed53cf | 2009-03-23 12:36:38 -0700 | [diff] [blame] | 853 | pTimeOfDay_p->m_dwMs = AmiGetDwordFromLe(((u8 *) pAddr_p)) & 0x0FFFFFFF; |
| 854 | pTimeOfDay_p->m_wDays = AmiGetWordFromLe(((u8 *) pAddr_p) + 4); |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 855 | |
| 856 | } |
| 857 | |
Daniel Krueger | 9d7164c | 2008-12-19 11:41:57 -0800 | [diff] [blame] | 858 | // EOF |
| 859 | |
| 860 | // Die letzte Zeile muß unbedingt eine leere Zeile sein, weil manche Compiler |
| 861 | // damit ein Problem haben, wenn das nicht so ist (z.B. GNU oder Borland C++ Builder). |