ARM Linux下添加自定义系统调用

    技术2022-05-19  21

    本文基于公司uClinux内核,详细讲述3代终端gpioctrl的原理及应用。

     

    ARM Linux的系统中断采用产生软中断,查找系统调用表,调用系统调用函数的方式实现系统调用。

    先讲述,如何去查找gpioctrl函数的实现。

    1.       通过查找,找到函数定义。

    Sg2klib.c里,有如下定义:

    _syscall3(int,gpioctrl, int, op, int, addr, int, value)

    _syscall3是一个宏定义,如下:

    #define _syscall3(type,name,type1,arg1,type2,arg2,type3,arg3)           /

    type name(type1 arg1,type2 arg2,type3 arg3) {                                  /

      long __res;                                                                     /

      __asm__ __volatile__ (                                                        /

      "mov/tr0,%1/n/t"                                                                  /

      "mov/tr1,%2/n/t"                                                                  /

      "mov/tr2,%3/n/t"                                                                  /

      __syscall(name)                                                            /

      "mov/t%0,r0"                                                                         /

            : "=r" (__res)                                                             /

            : "r" ((long)(arg1)),"r" ((long)(arg2)),"r" ((long)(arg3))     /

            : "r0","r1","r2","lr");                                                       /

      __syscall_return(type,__res);                                                     /

    }

    这个宏定义,用来定义一个内联汇编的函数。名称为name,传入3个参数arg1arg2arg33个参数,并返回type类型数据。

    说明:

    %0:即__res的引用

    %1%2%3:输入操作数,arg1arg2arg3的引用

    第一个冒号:输出操作数,“=r”约束操作束,说明操作数是输出操作数。

    第二个冒号:输入操作数,“r”指定将操作数存储在寄存器中。

    第三个冒号:告诉编译器将在内联汇编中修改"r0","r1","r2","lr"的值,这样 GCC 就不使用该寄存器存储任何其它的值。

     

    通过上述宏定义,即可定义一个函数

    int gpioctrl(int op, int addr, int value);

    函数功能是产生软中断,调用相应系统调用函数,并传入参数r0r1r2,返回值r0

    注意__syscall(name)__syscall_return也是宏定义,实现一个软中断,和返回函数返回值。

    /* unistd.h */

    #define __sys2(x) #x

    #define __sys1(x) __sys2(x)

     

    #ifndef __syscall

    #define __syscall(name) "swi/t" __sys1(__NR_##name) "/n/t"

    #endif

     

    #define __syscall_return(type, res)                                      /

    do {                                                                              /

    if ((unsigned long)(res) >= (unsigned long)(-125)) {           /

               errno = -(res);                                                 /

               res = -1;                                                  /

    }                                                                         /

    return (type) (res);                                                 /

    } while (0)

     

    产生的系统调用表sys_call_table定义在entry_common.S,表格包含在calls.S

    /* entry_common.S */

    .type         sys_call_table, #object

    ENTRY(sys_call_table)

    #include "calls.S"

     

    /* calls.S */

    .long SYMBOL_NAME(sys_gpioctrl)

     

    2.       真正的函数实现

    /* value : 参数地址 */

    asmlinkage int sys_gpioctrl( int op, int addr, int value)

    {

    int v;

    copy_from_user( &v, value, sizeof( int));

    switch( op ) {

               case 0: //OP_GET:

                        v = *(volatile int *)addr;

                        copy_to_user(value, &v, sizeof(int));

                        break;

               case 1: //OP_SET:

                        *(volatile int *)addr = v;

                        break;

               case 2: //OP_EOR:

                        *(volatile int *)addr ^= v;

                        break;

               case 3: //OP_ORR:

                        *(volatile unsigned long *)addr |= v;

                        break;

               case 4: //OP_AND:

                        *(volatile unsigned long *)addr &=v;

                        break;

               default:

                        break;

               }

    return 0;

    }

     

    3.       函数说明

    系统调用运行于内核空间,用户空间程序通过系统调用传入操作opt、地址addr、值value,进行寄存器的读取、设置等操作。

    #define OP_GET   0           /* 获取 */

    #define OP_SET   1           /* 设置 */

    #define OP_ERR   2           /* 异或 */

    #define OP_ORR   3                /* */

    #define OP_AND   4           /* */


    最新回复(0)