osfmk/arm/status_shared.c

   1 /*
   2  * Copyright (c) 2012 Apple Inc. All rights reserved.
   3  *
   4  * @APPLE_OSREFERENCE_LICENSE_HEADER_START@
   5  *
   6  * This file contains Original Code and/or Modifications of Original Code
   7  * as defined in and that are subject to the Apple Public Source License
   8  * Version 2.0 (the 'License'). You may not use this file except in
   9  * compliance with the License. The rights granted to you under the License
  10  * may not be used to create, or enable the creation or redistribution of,
  11  * unlawful or unlicensed copies of an Apple operating system, or to
  12  * circumvent, violate, or enable the circumvention or violation of, any
  13  * terms of an Apple operating system software license agreement.
  14  *
  15  * Please obtain a copy of the License at
  16  * http://www.opensource.apple.com/apsl/ and read it before using this file.
  17  *
  18  * The Original Code and all software distributed under the License are
  19  * distributed on an 'AS IS' basis, WITHOUT WARRANTY OF ANY KIND, EITHER
  20  * EXPRESS OR IMPLIED, AND APPLE HEREBY DISCLAIMS ALL SUCH WARRANTIES,
  21  * INCLUDING WITHOUT LIMITATION, ANY WARRANTIES OF MERCHANTABILITY,
  22  * FITNESS FOR A PARTICULAR PURPOSE, QUIET ENJOYMENT OR NON-INFRINGEMENT.
  23  * Please see the License for the specific language governing rights and
  24  * limitations under the License.
  25  *
  26  * @APPLE_OSREFERENCE_LICENSE_HEADER_END@
  27  */
  28 #include <debug.h>
  29 #include <mach/mach_types.h>
  30 #include <mach/kern_return.h>
  31 #include <mach/thread_status.h>
  32 #include <kern/thread.h>
  33 #include <kern/kalloc.h>
  34 #include <arm/vmparam.h>
  35 #include <arm/cpu_data_internal.h>
  36
  37 /*
  38  * Copy values from saved_state to ts32.
  39  */
  40 void
  41 saved_state_to_thread_state32(const arm_saved_state_t *saved_state, arm_thread_state32_t *ts32)
  42 {
  43         uint32_t i;
  44
  45         assert(is_saved_state32(saved_state));
  46
  47         ts32->lr = (uint32_t)get_saved_state_lr(saved_state);
  48         ts32->sp = (uint32_t)get_saved_state_sp(saved_state);
  49         ts32->pc = (uint32_t)get_saved_state_pc(saved_state);
  50         ts32->cpsr = get_saved_state_cpsr(saved_state);
  51         for (i = 0; i < 13; i++) {
  52                 ts32->r[i] = (uint32_t)get_saved_state_reg(saved_state, i);
  53         }
  54 }
  55
  56 /*
  57  * Copy values from ts32 to saved_state.
  58  */
  59 void
  60 thread_state32_to_saved_state(const arm_thread_state32_t *ts32, arm_saved_state_t *saved_state)
  61 {
  62         uint32_t i;
  63
  64         assert(is_saved_state32(saved_state));
  65
  66         set_saved_state_lr(saved_state, ts32->lr);
  67         set_saved_state_sp(saved_state, ts32->sp);
  68         set_saved_state_pc(saved_state, ts32->pc);
  69
  70 #if defined(__arm64__)
  71         set_saved_state_cpsr(saved_state, (ts32->cpsr & ~PSR64_MODE_MASK) | PSR64_MODE_RW_32);
  72 #elif defined(__arm__)
  73         set_saved_state_cpsr(saved_state, (ts32->cpsr & ~PSR_USER_MASK) | (ts32->cpsr & PSR_USER_MASK));
  74 #else
  75 #error Unknown architecture.
  76 #endif
  77
  78         for (i = 0; i < 13; i++) {
  79                 set_saved_state_reg(saved_state, i, ts32->r[i]);
  80         }
  81 }