kernel/arch/ia64/src/fpu_context.c

   1 /*
   2  * Copyright (c) 2005 Jakub Vana
   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
   7  * are met:
   8  *
   9  * - Redistributions of source code must retain the above copyright
  10  *   notice, this list of conditions and the following disclaimer.
  11  * - Redistributions in binary form must reproduce the above copyright
  12  *   notice, this list of conditions and the following disclaimer in the
  13  *   documentation and/or other materials provided with the distribution.
  14  * - The name of the author may not be used to endorse or promote products
  15  *   derived from this software without specific prior written permission.
  16  *
  17  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  18  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  19  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  20  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  21  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  22  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  23  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  24  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  25  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  26  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  27  */
  28
  29 /** @addtogroup ia64
  30  * @{
  31  */
  32 /** @file
  33  *
  34  */
  35
  36 #include <fpu_context.h>
  37 #include <arch/register.h>
  38 #include <print.h>
  39
  40 void fpu_context_save(fpu_context_t *fctx)
  41 {
  42         asm volatile (
  43                 "stf.spill [%0] = f32, 0x80\n"
  44                 "stf.spill [%1] = f33, 0x80\n"
  45                 "stf.spill [%2] = f34, 0x80\n"
  46                 "stf.spill [%3] = f35, 0x80\n"
  47                 "stf.spill [%4] = f36, 0x80\n"
  48                 "stf.spill [%5] = f37, 0x80\n"
  49                 "stf.spill [%6] = f38, 0x80\n"
  50                 "stf.spill [%7] = f39, 0x80\n;;"
  51
  52                 "stf.spill [%0] = f40, 0x80\n"
  53                 "stf.spill [%1] = f41, 0x80\n"
  54                 "stf.spill [%2] = f42, 0x80\n"
  55                 "stf.spill [%3] = f43, 0x80\n"
  56                 "stf.spill [%4] = f44, 0x80\n"
  57                 "stf.spill [%5] = f45, 0x80\n"
  58                 "stf.spill [%6] = f46, 0x80\n"
  59                 "stf.spill [%7] = f47, 0x80\n;;"
  60
  61                 "stf.spill [%0] = f48, 0x80\n"
  62                 "stf.spill [%1] = f49, 0x80\n"
  63                 "stf.spill [%2] = f50, 0x80\n"
  64                 "stf.spill [%3] = f51, 0x80\n"
  65                 "stf.spill [%4] = f52, 0x80\n"
  66                 "stf.spill [%5] = f53, 0x80\n"
  67                 "stf.spill [%6] = f54, 0x80\n"
  68                 "stf.spill [%7] = f55, 0x80\n;;"
  69
  70                 "stf.spill [%0] = f56, 0x80\n"
  71                 "stf.spill [%1] = f57, 0x80\n"
  72                 "stf.spill [%2] = f58, 0x80\n"
  73                 "stf.spill [%3] = f59, 0x80\n"
  74                 "stf.spill [%4] = f60, 0x80\n"
  75                 "stf.spill [%5] = f61, 0x80\n"
  76                 "stf.spill [%6] = f62, 0x80\n"
  77                 "stf.spill [%7] = f63, 0x80\n;;"
  78
  79                 "stf.spill [%0] = f64, 0x80\n"
  80                 "stf.spill [%1] = f65, 0x80\n"
  81                 "stf.spill [%2] = f66, 0x80\n"
  82                 "stf.spill [%3] = f67, 0x80\n"
  83                 "stf.spill [%4] = f68, 0x80\n"
  84                 "stf.spill [%5] = f69, 0x80\n"
  85                 "stf.spill [%6] = f70, 0x80\n"
  86                 "stf.spill [%7] = f71, 0x80\n;;"
  87
  88                 "stf.spill [%0] = f72, 0x80\n"
  89                 "stf.spill [%1] = f73, 0x80\n"
  90                 "stf.spill [%2] = f74, 0x80\n"
  91                 "stf.spill [%3] = f75, 0x80\n"
  92                 "stf.spill [%4] = f76, 0x80\n"
  93                 "stf.spill [%5] = f77, 0x80\n"
  94                 "stf.spill [%6] = f78, 0x80\n"
  95                 "stf.spill [%7] = f79, 0x80\n;;"
  96
  97                 "stf.spill [%0] = f80, 0x80\n"
  98                 "stf.spill [%1] = f81, 0x80\n"
  99                 "stf.spill [%2] = f82, 0x80\n"
 100                 "stf.spill [%3] = f83, 0x80\n"
 101                 "stf.spill [%4] = f84, 0x80\n"
 102                 "stf.spill [%5] = f85, 0x80\n"
 103                 "stf.spill [%6] = f86, 0x80\n"
 104                 "stf.spill [%7] = f87, 0x80\n;;"
 105
 106                 "stf.spill [%0] = f88, 0x80\n"
 107                 "stf.spill [%1] = f89, 0x80\n"
 108                 "stf.spill [%2] = f90, 0x80\n"
 109                 "stf.spill [%3] = f91, 0x80\n"
 110                 "stf.spill [%4] = f92, 0x80\n"
 111                 "stf.spill [%5] = f93, 0x80\n"
 112                 "stf.spill [%6] = f94, 0x80\n"
 113                 "stf.spill [%7] = f95, 0x80\n;;"
 114
 115                 "stf.spill [%0] = f96, 0x80\n"
 116                 "stf.spill [%1] = f97, 0x80\n"
 117                 "stf.spill [%2] = f98, 0x80\n"
 118                 "stf.spill [%3] = f99, 0x80\n"
 119                 "stf.spill [%4] = f100, 0x80\n"
 120                 "stf.spill [%5] = f101, 0x80\n"
 121                 "stf.spill [%6] = f102, 0x80\n"
 122                 "stf.spill [%7] = f103, 0x80\n;;"
 123
 124                 "stf.spill [%0] = f104, 0x80\n"
 125                 "stf.spill [%1] = f105, 0x80\n"
 126                 "stf.spill [%2] = f106, 0x80\n"
 127                 "stf.spill [%3] = f107, 0x80\n"
 128                 "stf.spill [%4] = f108, 0x80\n"
 129                 "stf.spill [%5] = f109, 0x80\n"
 130                 "stf.spill [%6] = f110, 0x80\n"
 131                 "stf.spill [%7] = f111, 0x80\n;;"
 132
 133                 "stf.spill [%0] = f112, 0x80\n"
 134                 "stf.spill [%1] = f113, 0x80\n"
 135                 "stf.spill [%2] = f114, 0x80\n"
 136                 "stf.spill [%3] = f115, 0x80\n"
 137                 "stf.spill [%4] = f116, 0x80\n"
 138                 "stf.spill [%5] = f117, 0x80\n"
 139                 "stf.spill [%6] = f118, 0x80\n"
 140                 "stf.spill [%7] = f119, 0x80\n;;"
 141
 142                 "stf.spill [%0] = f120, 0x80\n"
 143                 "stf.spill [%1] = f121, 0x80\n"
 144                 "stf.spill [%2] = f122, 0x80\n"
 145                 "stf.spill [%3] = f123, 0x80\n"
 146                 "stf.spill [%4] = f124, 0x80\n"
 147                 "stf.spill [%5] = f125, 0x80\n"
 148                 "stf.spill [%6] = f126, 0x80\n"
 149                 "stf.spill [%7] = f127, 0x80\n;;"
 150
 151                 :
 152                 : "r" (&((fctx->fr)[0])), "r" (&((fctx->fr)[1])), "r" (&((fctx->fr)[2])), "r" (&((fctx->fr)[3])),
 153                   "r" (&((fctx->fr)[4])), "r" (&((fctx->fr)[5])), "r" (&((fctx->fr)[6])), "r" (&((fctx->fr)[7]))
 154         );
 155
 156 }
 157
 158 void fpu_context_restore(fpu_context_t *fctx)
 159 {
 160         asm volatile (
 161                 "ldf.fill f32 = [%0], 0x80\n"
 162                 "ldf.fill f33 = [%1], 0x80\n"
 163                 "ldf.fill f34 = [%2], 0x80\n"
 164                 "ldf.fill f35 = [%3], 0x80\n"
 165                 "ldf.fill f36 = [%4], 0x80\n"
 166                 "ldf.fill f37 = [%5], 0x80\n"
 167                 "ldf.fill f38 = [%6], 0x80\n"
 168                 "ldf.fill f39 = [%7], 0x80\n;;"
 169
 170                 "ldf.fill f40 = [%0], 0x80\n"
 171                 "ldf.fill f41 = [%1], 0x80\n"
 172                 "ldf.fill f42 = [%2], 0x80\n"
 173                 "ldf.fill f43 = [%3], 0x80\n"
 174                 "ldf.fill f44 = [%4], 0x80\n"
 175                 "ldf.fill f45 = [%5], 0x80\n"
 176                 "ldf.fill f46 = [%6], 0x80\n"
 177                 "ldf.fill f47 = [%7], 0x80\n;;"
 178
 179                 "ldf.fill f48 = [%0], 0x80\n"
 180                 "ldf.fill f49 = [%1], 0x80\n"
 181                 "ldf.fill f50 = [%2], 0x80\n"
 182                 "ldf.fill f51 = [%3], 0x80\n"
 183                 "ldf.fill f52 = [%4], 0x80\n"
 184                 "ldf.fill f53 = [%5], 0x80\n"
 185                 "ldf.fill f54 = [%6], 0x80\n"
 186                 "ldf.fill f55 = [%7], 0x80\n;;"
 187
 188                 "ldf.fill f56 = [%0], 0x80\n"
 189                 "ldf.fill f57 = [%1], 0x80\n"
 190                 "ldf.fill f58 = [%2], 0x80\n"
 191                 "ldf.fill f59 = [%3], 0x80\n"
 192                 "ldf.fill f60 = [%4], 0x80\n"
 193                 "ldf.fill f61 = [%5], 0x80\n"
 194                 "ldf.fill f62 = [%6], 0x80\n"
 195                 "ldf.fill f63 = [%7], 0x80\n;;"
 196
 197                 "ldf.fill f64 = [%0], 0x80\n"
 198                 "ldf.fill f65 = [%1], 0x80\n"
 199                 "ldf.fill f66 = [%2], 0x80\n"
 200                 "ldf.fill f67 = [%3], 0x80\n"
 201                 "ldf.fill f68 = [%4], 0x80\n"
 202                 "ldf.fill f69 = [%5], 0x80\n"
 203                 "ldf.fill f70 = [%6], 0x80\n"
 204                 "ldf.fill f71 = [%7], 0x80\n;;"
 205
 206                 "ldf.fill f72 = [%0], 0x80\n"
 207                 "ldf.fill f73 = [%1], 0x80\n"
 208                 "ldf.fill f74 = [%2], 0x80\n"
 209                 "ldf.fill f75 = [%3], 0x80\n"
 210                 "ldf.fill f76 = [%4], 0x80\n"
 211                 "ldf.fill f77 = [%5], 0x80\n"
 212                 "ldf.fill f78 = [%6], 0x80\n"
 213                 "ldf.fill f79 = [%7], 0x80\n;;"
 214
 215                 "ldf.fill f80 = [%0], 0x80\n"
 216                 "ldf.fill f81 = [%1], 0x80\n"
 217                 "ldf.fill f82 = [%2], 0x80\n"
 218                 "ldf.fill f83 = [%3], 0x80\n"
 219                 "ldf.fill f84 = [%4], 0x80\n"
 220                 "ldf.fill f85 = [%5], 0x80\n"
 221                 "ldf.fill f86 = [%6], 0x80\n"
 222                 "ldf.fill f87 = [%7], 0x80\n;;"
 223
 224                 "ldf.fill f88 = [%0], 0x80\n"
 225                 "ldf.fill f89 = [%1], 0x80\n"
 226                 "ldf.fill f90 = [%2], 0x80\n"
 227                 "ldf.fill f91 = [%3], 0x80\n"
 228                 "ldf.fill f92 = [%4], 0x80\n"
 229                 "ldf.fill f93 = [%5], 0x80\n"
 230                 "ldf.fill f94 = [%6], 0x80\n"
 231                 "ldf.fill f95 = [%7], 0x80\n;;"
 232
 233                 "ldf.fill f96 = [%0], 0x80\n"
 234                 "ldf.fill f97 = [%1], 0x80\n"
 235                 "ldf.fill f98 = [%2], 0x80\n"
 236                 "ldf.fill f99 = [%3], 0x80\n"
 237                 "ldf.fill f100 = [%4], 0x80\n"
 238                 "ldf.fill f101 = [%5], 0x80\n"
 239                 "ldf.fill f102 = [%6], 0x80\n"
 240                 "ldf.fill f103 = [%7], 0x80\n;;"
 241
 242                 "ldf.fill f104 = [%0], 0x80\n"
 243                 "ldf.fill f105 = [%1], 0x80\n"
 244                 "ldf.fill f106 = [%2], 0x80\n"
 245                 "ldf.fill f107 = [%3], 0x80\n"
 246                 "ldf.fill f108 = [%4], 0x80\n"
 247                 "ldf.fill f109 = [%5], 0x80\n"
 248                 "ldf.fill f110 = [%6], 0x80\n"
 249                 "ldf.fill f111 = [%7], 0x80\n;;"
 250
 251                 "ldf.fill f112 = [%0], 0x80\n"
 252                 "ldf.fill f113 = [%1], 0x80\n"
 253                 "ldf.fill f114 = [%2], 0x80\n"
 254                 "ldf.fill f115 = [%3], 0x80\n"
 255                 "ldf.fill f116 = [%4], 0x80\n"
 256                 "ldf.fill f117 = [%5], 0x80\n"
 257                 "ldf.fill f118 = [%6], 0x80\n"
 258                 "ldf.fill f119 = [%7], 0x80\n;;"
 259
 260                 "ldf.fill f120 = [%0], 0x80\n"
 261                 "ldf.fill f121 = [%1], 0x80\n"
 262                 "ldf.fill f122 = [%2], 0x80\n"
 263                 "ldf.fill f123 = [%3], 0x80\n"
 264                 "ldf.fill f124 = [%4], 0x80\n"
 265                 "ldf.fill f125 = [%5], 0x80\n"
 266                 "ldf.fill f126 = [%6], 0x80\n"
 267                 "ldf.fill f127 = [%7], 0x80\n;;"
 268
 269                 :
 270                 : "r" (&((fctx->fr)[0])), "r" (&((fctx->fr)[1])), "r" (&((fctx->fr)[2])), "r" (&((fctx->fr)[3])),
 271                   "r" (&((fctx->fr)[4])), "r" (&((fctx->fr)[5])), "r" (&((fctx->fr)[6])), "r" (&((fctx->fr)[7]))
 272         );
 273 }
 274
 275 void fpu_enable(void)
 276 {
 277         uint64_t a = 0 ;
 278
 279         asm volatile (
 280                 "rsm %0 ;;"
 281                 "srlz.i\n"
 282                 "srlz.d ;;\n"
 283                 :
 284                 : "i" (PSR_DFH_MASK)
 285         );
 286
 287         asm volatile (
 288                 "mov %0 = ar.fpsr ;;\n"
 289                 "or %0 = %0,%1 ;;\n"
 290                 "mov ar.fpsr = %0 ;;\n"
 291                 : "+r" (a)
 292                 : "r" (0x38)
 293         );
 294 }
 295
 296 void fpu_disable(void)
 297 {
 298         uint64_t a = 0 ;
 299
 300         asm volatile (
 301                 "ssm %0 ;;\n"
 302                 "srlz.i\n"
 303                 "srlz.d ;;\n"
 304                 :
 305                 : "i" (PSR_DFH_MASK)
 306         );
 307
 308         asm volatile (
 309                 "mov %0 = ar.fpsr ;;\n"
 310                 "or %0 = %0,%1 ;;\n"
 311                 "mov ar.fpsr = %0 ;;\n"
 312                 : "+r" (a)
 313                 : "r" (0x38)
 314         );
 315 }
 316
 317 void fpu_init(void)
 318 {
 319         uint64_t a = 0 ;
 320
 321         asm volatile (
 322                 "mov %0 = ar.fpsr ;;\n"
 323                 "or %0 = %0,%1 ;;\n"
 324                 "mov ar.fpsr = %0 ;;\n"
 325                 : "+r" (a)
 326                 : "r" (0x38)
 327         );
 328
 329         asm volatile (
 330                 "mov f2 = f0\n"
 331                 "mov f3 = f0\n"
 332                 "mov f4 = f0\n"
 333                 "mov f5 = f0\n"
 334                 "mov f6 = f0\n"
 335                 "mov f7 = f0\n"
 336                 "mov f8 = f0\n"
 337                 "mov f9 = f0\n"
 338
 339                 "mov f10 = f0\n"
 340                 "mov f11 = f0\n"
 341                 "mov f12 = f0\n"
 342                 "mov f13 = f0\n"
 343                 "mov f14 = f0\n"
 344                 "mov f15 = f0\n"
 345                 "mov f16 = f0\n"
 346                 "mov f17 = f0\n"
 347                 "mov f18 = f0\n"
 348                 "mov f19 = f0\n"
 349
 350                 "mov f20 = f0\n"
 351                 "mov f21 = f0\n"
 352                 "mov f22 = f0\n"
 353                 "mov f23 = f0\n"
 354                 "mov f24 = f0\n"
 355                 "mov f25 = f0\n"
 356                 "mov f26 = f0\n"
 357                 "mov f27 = f0\n"
 358                 "mov f28 = f0\n"
 359                 "mov f29 = f0\n"
 360
 361                 "mov f30 = f0\n"
 362                 "mov f31 = f0\n"
 363                 "mov f32 = f0\n"
 364                 "mov f33 = f0\n"
 365                 "mov f34 = f0\n"
 366                 "mov f35 = f0\n"
 367                 "mov f36 = f0\n"
 368                 "mov f37 = f0\n"
 369                 "mov f38 = f0\n"
 370                 "mov f39 = f0\n"
 371
 372                 "mov f40 = f0\n"
 373                 "mov f41 = f0\n"
 374                 "mov f42 = f0\n"
 375                 "mov f43 = f0\n"
 376                 "mov f44 = f0\n"
 377                 "mov f45 = f0\n"
 378                 "mov f46 = f0\n"
 379                 "mov f47 = f0\n"
 380                 "mov f48 = f0\n"
 381                 "mov f49 = f0\n"
 382
 383                 "mov f50 = f0\n"
 384                 "mov f51 = f0\n"
 385                 "mov f52 = f0\n"
 386                 "mov f53 = f0\n"
 387                 "mov f54 = f0\n"
 388                 "mov f55 = f0\n"
 389                 "mov f56 = f0\n"
 390                 "mov f57 = f0\n"
 391                 "mov f58 = f0\n"
 392                 "mov f59 = f0\n"
 393
 394                 "mov f60 = f0\n"
 395                 "mov f61 = f0\n"
 396                 "mov f62 = f0\n"
 397                 "mov f63 = f0\n"
 398                 "mov f64 = f0\n"
 399                 "mov f65 = f0\n"
 400                 "mov f66 = f0\n"
 401                 "mov f67 = f0\n"
 402                 "mov f68 = f0\n"
 403                 "mov f69 = f0\n"
 404
 405                 "mov f70 = f0\n"
 406                 "mov f71 = f0\n"
 407                 "mov f72 = f0\n"
 408                 "mov f73 = f0\n"
 409                 "mov f74 = f0\n"
 410                 "mov f75 = f0\n"
 411                 "mov f76 = f0\n"
 412                 "mov f77 = f0\n"
 413                 "mov f78 = f0\n"
 414                 "mov f79 = f0\n"
 415
 416                 "mov f80 = f0\n"
 417                 "mov f81 = f0\n"
 418                 "mov f82 = f0\n"
 419                 "mov f83 = f0\n"
 420                 "mov f84 = f0\n"
 421                 "mov f85 = f0\n"
 422                 "mov f86 = f0\n"
 423                 "mov f87 = f0\n"
 424                 "mov f88 = f0\n"
 425                 "mov f89 = f0\n"
 426
 427                 "mov f90 = f0\n"
 428                 "mov f91 = f0\n"
 429                 "mov f92 = f0\n"
 430                 "mov f93 = f0\n"
 431                 "mov f94 = f0\n"
 432                 "mov f95 = f0\n"
 433                 "mov f96 = f0\n"
 434                 "mov f97 = f0\n"
 435                 "mov f98 = f0\n"
 436                 "mov f99 = f0\n"
 437
 438                 "mov f100 = f0\n"
 439                 "mov f101 = f0\n"
 440                 "mov f102 = f0\n"
 441                 "mov f103 = f0\n"
 442                 "mov f104 = f0\n"
 443                 "mov f105 = f0\n"
 444                 "mov f106 = f0\n"
 445                 "mov f107 = f0\n"
 446                 "mov f108 = f0\n"
 447                 "mov f109 = f0\n"
 448
 449                 "mov f110 = f0\n"
 450                 "mov f111 = f0\n"
 451                 "mov f112 = f0\n"
 452                 "mov f113 = f0\n"
 453                 "mov f114 = f0\n"
 454                 "mov f115 = f0\n"
 455                 "mov f116 = f0\n"
 456                 "mov f117 = f0\n"
 457                 "mov f118 = f0\n"
 458                 "mov f119 = f0\n"
 459
 460                 "mov f120 = f0\n"
 461                 "mov f121 = f0\n"
 462                 "mov f122 = f0\n"
 463                 "mov f123 = f0\n"
 464                 "mov f124 = f0\n"
 465                 "mov f125 = f0\n"
 466                 "mov f126 = f0\n"
 467                 "mov f127 = f0\n"
 468         );
 469
 470 }
 471
 472 /** @}
 473  */