Line data    Source code

       1            0 : /*
       2              :  * Copyright (c) 2015, Wind River Systems, Inc.
       3              :  *
       4              :  * SPDX-License-Identifier: Apache-2.0
       5              :  */
       6              : 
       7              : /* Implementation of sys_io.h's documented functions */
       8              : 
       9              : #ifndef ZEPHYR_INCLUDE_ARCH_X86_IA32_SYS_IO_H_
      10              : #define ZEPHYR_INCLUDE_ARCH_X86_IA32_SYS_IO_H_
      11              : 
      12              : #if !defined(_ASMLANGUAGE)
      13              : 
      14              : #include <zephyr/sys/sys_io.h>
      15              : #include <zephyr/types.h>
      16              : #include <stddef.h>
      17              : 
      18              : static ALWAYS_INLINE
      19            0 :         void sys_io_set_bit(io_port_t port, unsigned int bit)
      20              : {
      21              :         uint32_t reg = 0;
      22              : 
      23              :         __asm__ volatile("inl      %w1, %0;\n\t"
      24              :                          "btsl     %2, %0;\n\t"
      25              :                          "outl     %0, %w1;\n\t"
      26              :                          :
      27              :                          : "a" (reg), "Nd" (port), "Ir" (bit));
      28              : }
      29              : 
      30              : static ALWAYS_INLINE
      31            0 :         void sys_io_clear_bit(io_port_t port, unsigned int bit)
      32              : {
      33              :         uint32_t reg = 0;
      34              : 
      35              :         __asm__ volatile("inl      %w1, %0;\n\t"
      36              :                          "btrl     %2, %0;\n\t"
      37              :                          "outl     %0, %w1;\n\t"
      38              :                          :
      39              :                          : "a" (reg), "Nd" (port), "Ir" (bit));
      40              : }
      41              : 
      42              : static ALWAYS_INLINE
      43            0 :         int sys_io_test_bit(io_port_t port, unsigned int bit)
      44              : {
      45              :         uint32_t ret;
      46              : 
      47              :         __asm__ volatile("inl      %w1, %0\n\t"
      48              :                          "btl      %2, %0\n\t"
      49              :                          : "=a" (ret)
      50              :                          : "Nd" (port), "Ir" (bit));
      51              : 
      52              :         return (ret & 1U);
      53              : }
      54              : 
      55              : static ALWAYS_INLINE
      56            0 :         int sys_io_test_and_set_bit(io_port_t port, unsigned int bit)
      57              : {
      58              :         int ret;
      59              : 
      60              :         ret = sys_io_test_bit(port, bit);
      61              :         sys_io_set_bit(port, bit);
      62              : 
      63              :         return ret;
      64              : }
      65              : 
      66              : static ALWAYS_INLINE
      67            0 :         int sys_io_test_and_clear_bit(io_port_t port, unsigned int bit)
      68              : {
      69              :         int ret;
      70              : 
      71              :         ret = sys_io_test_bit(port, bit);
      72              :         sys_io_clear_bit(port, bit);
      73              : 
      74              :         return ret;
      75              : }
      76              : 
      77              : #endif /* _ASMLANGUAGE */
      78              : 
      79              : #endif /* ZEPHYR_INCLUDE_ARCH_X86_IA32_SYS_IO_H_ */