Line data    Source code

       1           0 : /*
       2             :  * Copyright (c) 2015 Intel Corporation.
       3             :  *
       4             :  * SPDX-License-Identifier: Apache-2.0
       5             :  */
       6             : 
       7             : #ifndef ZEPHYR_INCLUDE_ARCH_ARC_V2_SYS_IO_H_
       8             : #define ZEPHYR_INCLUDE_ARCH_ARC_V2_SYS_IO_H_
       9             : 
      10             : #ifndef _ASMLANGUAGE
      11             : 
      12             : #include <zephyr/toolchain.h>
      13             : #include <zephyr/sys/sys_io.h>
      14             : #include <zephyr/arch/arc/v2/aux_regs.h>
      15             : 
      16             : #include <zephyr/types.h>
      17             : #include <stddef.h>
      18             : 
      19             : #ifdef __cplusplus
      20             : extern "C" {
      21             : #endif
      22             : 
      23             : /* Implementation of sys_io.h's documented functions */
      24             : 
      25             : static ALWAYS_INLINE
      26           0 :         void sys_out8(uint8_t data, io_port_t port)
      27             : {
      28             :         z_arc_v2_aux_reg_write(port, data);
      29             : }
      30             : 
      31             : static ALWAYS_INLINE
      32           0 :         uint8_t sys_in8(io_port_t port)
      33             : {
      34             :         return (uint8_t)(z_arc_v2_aux_reg_read(port) & 0x000000ff);
      35             : }
      36             : 
      37             : static ALWAYS_INLINE
      38           0 :         void sys_out16(uint16_t data, io_port_t port)
      39             : {
      40             :         z_arc_v2_aux_reg_write(port, data);
      41             : }
      42             : 
      43             : static ALWAYS_INLINE
      44           0 :         uint16_t sys_in16(io_port_t port)
      45             : {
      46             :         return (uint16_t)(z_arc_v2_aux_reg_read(port) & 0x0000ffff);
      47             : }
      48             : 
      49             : static ALWAYS_INLINE
      50           0 :         void sys_out32(uint32_t data, io_port_t port)
      51             : {
      52             :         z_arc_v2_aux_reg_write(port, data);
      53             : }
      54             : 
      55             : static ALWAYS_INLINE
      56           0 :         uint32_t sys_in32(io_port_t port)
      57             : {
      58             :         return z_arc_v2_aux_reg_read(port);
      59             : }
      60             : 
      61             : static ALWAYS_INLINE
      62           0 :         void sys_io_set_bit(io_port_t port, unsigned int bit)
      63             : {
      64             :         uint32_t reg = 0;
      65             : 
      66             :         __asm__ volatile("lr       %1, [%0]\n"
      67             :                          "bset     %1, %1, %2\n"
      68             :                          "sr       %1, [%0];\n\t"
      69             :                          :
      70             :                          : "ir" (port),
      71             :                            "r" (reg), "ir" (bit)
      72             :                          : "memory", "cc");
      73             : }
      74             : 
      75             : static ALWAYS_INLINE
      76           0 :         void sys_io_clear_bit(io_port_t port, unsigned int bit)
      77             : {
      78             :         uint32_t reg = 0;
      79             : 
      80             :         __asm__ volatile("lr       %1, [%0]\n"
      81             :                          "bclr     %1, %1, %2\n"
      82             :                          "sr       %1, [%0];\n\t"
      83             :                          :
      84             :                          : "ir" (port),
      85             :                            "r" (reg), "ir" (bit)
      86             :                          : "memory", "cc");
      87             : }
      88             : 
      89             : static ALWAYS_INLINE
      90           0 :         int sys_io_test_bit(io_port_t port, unsigned int bit)
      91             : {
      92             :         uint32_t status = _ARC_V2_STATUS32;
      93             :         uint32_t reg = 0;
      94             :         uint32_t ret;
      95             : 
      96             :         __asm__ volatile("lr       %2, [%1]\n"
      97             :                          "btst     %2, %3\n"
      98             :                          "lr       %0, [%4];\n\t"
      99             :                          : "=r" (ret)
     100             :                          : "ir" (port),
     101             :                            "r" (reg), "ir" (bit), "i" (status)
     102             :                          : "memory", "cc");
     103             : 
     104             :         return !(ret & _ARC_V2_STATUS32_Z);
     105             : }
     106             : 
     107             : static ALWAYS_INLINE
     108           0 :         int sys_io_test_and_set_bit(io_port_t port, unsigned int bit)
     109             : {
     110             :         int ret;
     111             : 
     112             :         ret = sys_io_test_bit(port, bit);
     113             :         sys_io_set_bit(port, bit);
     114             : 
     115             :         return ret;
     116             : }
     117             : 
     118             : static ALWAYS_INLINE
     119           0 :         int sys_io_test_and_clear_bit(io_port_t port, unsigned int bit)
     120             : {
     121             :         int ret;
     122             : 
     123             :         ret = sys_io_test_bit(port, bit);
     124             :         sys_io_clear_bit(port, bit);
     125             : 
     126             :         return ret;
     127             : }
     128             : 
     129             : #ifdef __cplusplus
     130             : }
     131             : #endif
     132             : 
     133             : #endif /* _ASMLANGUAGE */
     134             : 
     135             : #endif /* ZEPHYR_INCLUDE_ARCH_ARC_V2_SYS_IO_H_ */