To control a standard servo motor we need to be able to generate a stable PWM signal of certain characteristics. For servo motor control this typically means a 5V digital square signal pulsing every 20ms with a variable puls e duration of 0.5ms to 2.5 ms; with these signals, a pulse duration of 0.5 ms sets the rotor at a 0 degree angle while a duration of 2.5 ms usually moves it to a 180 degrees position.  However do notice that the pulse duration and the operating voltage may vary depending on the motor.

What is really important for all servo motors is that the PWM signal has to be stable since otherwise the  position of the rotor will start shaking instead of staying in place.

PWM devices often found on SoCs have no fixed purpose and it is  with those devices in mind that the Linux kernel provides a PWM API. This way a standard communication mechanism can be used to drive LEDs or fans or the vibrators used in haptic interfaces for example. But  what can we do when our SoC or platform does not include any PWM  modules? One option is to use one of the available GPIOs (we will probably need a voltage level shifter) and a couple of timers to generate the PWM signal and hope that the timer interrupt latencies are not affected by the overall system behavior.

If we’d rather avoid the risk of having a shaky motor when soft-generating the PWM signal, we should actually patch the Linux kernel with some form of real-time support (this could be preempt-rt,  RTAI,  Xenomai/IPIPE). Just be aware that different real-time providers might result different better latencies depending on the platform, kernel versions, driver stability and so on.

I will use a Grove Servo and Xenomai/I-PIPE on the 96Boards HiKey platform to demonstrate with an example. 

Patching the Linux Kernel with real-time support
In order to clarify terms a little I’ll start by mentioning that Xenomai3 is not a real-time provider (which is optional) but an RTOS abstraction layer: Xenomai does allow VxWorks, pSoS and other RTOS applications to run on Linux without major modifications. But in order to guarantee the deadlines of any of its clients Xenomai logically does require realtime support.

Since Xenomai3, realtime-support can be achieved either by a kernel patched with  PREEMPT_RT or by enabling its own co-kernel (named Cobalt). In the later case, the Cobalt co-kernel would execute as the head of an interrupt pipeline (I-PIPE formerly known as ADEOS) while Linux would be the secondary domain in the pipe.
In this exercise we will use Cobalt as the real-time provider for simplicity.

In order the be able to execute the Cobalt co-kernel, the Linux kernel needs to first be patched with what in Xenomai terms is called an interrupt pipeline:
” The I-pipe inserts itself between the interrupt-management hardware and Linux. Any attempt from any Linux component to disable interrupts results in Linux’s I-pipe stage to be stalled. While stalled, a pipeline stage will not receive interrupts. However, any pipeline stage of higher priority will continue receiving interrupts, unless it too stalled its own stage. It follows that interrupts are almost never disabled”

The interrupt pipeline is delivered in the form of a kernel patch and maintained outside of the Linux kernel tree.
For HiKey all that would be required is to replace the kernel from any of the releases currently available with the I-PIPE aarch64 patched kernel for this board.

For 96Boards HiKey users it is enough with cloning the following repository checking out the hikey branch:
$ git clone http://git.xenomai.org/ipipe-jro.git  linux.git
$ cd linux.git
$ git checkout hikey

Xenomai3  for aarch64 remains work in progress and it hasn’t been merged yet in the project’s master branch. Despite of this some effort was invested during our last Linaro Connect 2015 in SFO and support was added to both 96Boards: HiKey running kernel v3.18 (all Linaro HiKey releases to date) and Dragon 410c running kernel v4.0.0 (Linaro Release 15.07).

So in order to install the Cobalt co-kernel in the I-PIPE enabled kernel just do:
$ git clone http://git.xenomai.org/xenomai-jro.git/ xenomai3.git
$ cd xenomai3.git
$ git checkout hikey
$ cd scripts/
$ ./prepare-kernel.sh –arch=arm64 –linux=$kernel

At this point you have a Linux kernel patched with I-PIPE and the Xenomai Cobalt co-kernel enabled and registered with the I-PIPE framework.

Installing the Xenomai libraries and demos
Now that we have a real-time enabled kernel we need to configure it and build it. In this example I am cross compiling the kernel (I am lucky to have a good server) but you could choose to build locally.
When you configure your kernel, you’ll need to to disable power management and enable the Xenomai gpiopwm driver

$ cd $kernel
$ make ARCH=arm64 defconfig
$ make ARCH=arm64 menuconfig
$ make ARCH=arm64 CROSS_COMPILE=aarch64-linux-gnu- -j8

If you are already running the latest HiKey release you will be using grub.cfg to choose kernels at boot time.
I suggest you create an NFS share ($share) on your server which you’ll mount on the HiKey file system. We will use this share to install the kernel modules and the Xenomai libraries as well as copying the Image and device tree.

$ make ARCH=arm64 CROSS_COMPILE=aarch64-linux-gnu- INSTALL_MOD_PATH=$share modules_install   
$ cp arch/arm64/boot/Image $share/
$ cp arch/arm64/boot/dts/hi6220-hikey.dtb $share/

Building Xenomai is usually done outside the tree after bootstraping:
$ cd xenomai3.git
$ scripts/bootstrap

Now create a build directory somewhere in your x86_64 build server:
$ mkdir build
$ cd build
$ $xenomai/configure –with-core=cobalt  –enable-smp –disable-tls –enable-fortify –enable-maintainer-mode –disable-registry –disable-pshared –disable-lorew-clock –enable-assert –disable-doc-install –build=x86_64 –host=aarch64-linux-gnu  CFLAGS=”-march=armv8-a” –prefix=/usr/xenomai
$ make -j8
$ make install DESTDIR=$share

After this step, the NFS share should contain:

  1. lib/modules/kernel_version
  2. Image
  3. hi6220-hikey.dtb
  4. usr/xenomai

Now it is the time to mount the $share partition on the HiKey (unless you modified fstab to always do this) and install the new kernel, libraries and drivers. This basically means modifying the grub.cfg entry to use the new Image/device tree and copying lib/modules and usr/xenomai to the root file system on your HiKey.
 

Running Xenomai
After booting, add an entry to /etc/ld.so.conf.d so the applications can find the Xenomai libraries
$ sudo echo “/usr/xenomai/lib” > /etc/ld.so.conf.d/xenomai.conf

Also add /usr/xenomai/bin to your $PATH.
You can now check that Xenomai is actually functional by executing the latency test:
$ root@linaro-alip:~# latency
== Sampling period: 1000 us
== Test mode: periodic user-mode task
== All results in microseconds
warming up…
RTT| 00:00:02 (periodic user-mode task, 1000 us period, priority 99)
RTH|—-lat min|—-lat avg|—-lat max|-overrun|—msw|—lat best|–lat worst
RTD| 3.333| 3.416| 17.500| 0| 0| 3.333| 17.500
RTD| 3.333| 3.428| 18.333| 0| 0| 3.333| 18.333
RTD| 3.333| 3.376| 5.000| 0| 0| 3.333| 18.333
RTD| 3.333| 3.376| 5.000| 0| 0| 3.333| 18.333
RTD| 3.333| 3.376| 5.000| 0| 0| 3.333| 18.333
RTD| 3.333| 3.376| 5.000| 0| 0| 3.333| 18.333
RTD| 3.333| 3.555| 19.167| 0| 0| 3.333| 19.167
RTD| 3.333| 3.555| 19.167| 0| 0| 3.333| 19.167
RTD| 3.333| 3.555| 19.167| 0| 0| 3.333| 19.167
RTD| 3.333| 3.555| 19.167| 0| 0| 3.333| 19.167
RTD| 3.333| 3.380| 5.000| 0| 0| 3.333| 19.167
RTD| 3.333| 3.380| 5.000| 0| 0| 3.333| 19.167
RTD| 3.333| 3.499| 15.833| 0| 0| 3.333| 19.167


Generating a PWM signal with a GPIO

I wrote the following RTDM  (Real Time Driver Model, this is a link to Jan Kiszka’s paperdriver to generate the PWM signal. If you configured your kernel properly, you should now see the eight gpiopwm nodes in /dev/rtdm/.  We should be able to control eight servo motors using eight different GPIOS.  The driver itself is no more complex than a couple of timers associated to each node to set/clear the GPIO line under application control: in this way, the application can specify the duty cycle of the PWM signal and therefore control the motor.

The driver as I said before it is actually quite straightforward but of course feel free to contact me or post questions on the 96Boards forums if you need any clarifications.

I also wrote this POSIX Xenomai application that shows how to use the driver (in automatic sweep mode or in manual mode using the keyboard to setup the different duty cycles)

Usage:
gpiopwm –config=dev:min:max:period:gpio:duty [–sweep=step | –manual] –dbg

where the config parameters represent:

–config:
dev: /dev/rtdm/gpio-pwm id [0..7] min: min active period in usec
max: max active period in usec
period: base signal period in nsec
gpio: gpio pin number
duty: default duty cycle [0..100]

–sweep:
step: sweep all duty cycle ranges in a loop
in step increments [default 1, value from 0..100]

–manual control duty cycle from the command line
–dbg enable driver debug output

An example of usage for a servo motor control (20ms period, 700usec min, 2200usec max cycle using GPIO 488 in ) would be

$ gpiopwm –config=1:700:2200:20000000:488:0 –sweep=100

This  would cause the motor to sweep (warning: the previous link is a video) from 0 to 180 degrees back and forth in 180 degrees increments (from 0 to 180 back and forth).

Enabling the –debug options will generate information in the console  every time there is a variation in the duty period due to a timer expiring early/late with respect to previous positions.

It will also warn if that variation in the duty period would cause the motor to miss a position.

 

I hope that this example can be of some help to those of you trying to control servo motors from any of the 96Boards.

Have fun!

 

 

Showing 16 comments
  • Profile photo of rjsstewart
    rjsstewart

    I’m unable to clone the ipipe git via the link provided above. Here’s the command line and the response:

    bob@tegra-ubuntu:~$ git clone http://git.xenomai.org/ipipe-jro.git linux.git
    Cloning into ‘linux.git’…
    Checking connectivity… done.
    warning: remote HEAD refers to nonexistent ref, unable to checkout.

    So, it looks like the related default branch of the repository has been deleted.

    In the jro part of the ipipe git I found a link, https://git.xenomai.org/ipipe-jro.git/snapshot/ipipe-jro-410c.linaro-15.07.tar.bz2. Is that the tar version of the clone?
    Bob Stewart

    • Profile photo of ldts
      ldts

      please try using the git protocol instead of http/https (in the meantime we will try to fix this in our servers)

      $ git clone git://git.xenomai.org/ipipe-jro.git linux.git

      • Profile photo of ldts
        ldts

        the warning is only due to having deleted the master branch in my repo (not protocol related). please ignore the warning and after cloning simply checkout the branch that you need as per the instructions.

        • Profile photo of rjsstewart
          rjsstewart

          …but nothing is transferred—linux.git is empty, Jorge,

          • Profile photo of rjsstewart
            rjsstewart

            The problem is my lack of git understanding. There is nothing transferred until I issue the checkout command as you instructions show. Then the files are transferred.

          • Profile photo of rjsstewart
            rjsstewart

            Looks like the linux/ipipe clone now works without any issue”(does take a while):

            $ git clone http://git.xenomai.org/ipipe-jro.git linux.git
            Cloning into ‘linux.git’…
            Checking connectivity… done.
            Checking out files: 100% (48620/48620), done.
            bob@linaro-developer:/Dragonboard$ ls -a linux.git
            . .mailmap Kbuild README block fixup.S include lib samples tools
            .. COPYING Kconfig REPORTING-BUGS crypto fixup.bin init linaro scripts usr
            .git CREDITS MAINTAINERS android drivers fixup.txt ipc mm security virt
            .gitignore Documentation Makefile arch firmware fs kernel net sound

  • Profile photo of chenghao
    chenghao

    We are trying to install Xenomai on the 410c,but failed.Could you please tell us if there is any instructions about how to install Xenomai on the 410c instead of hiki?Thanks so much!

  • Profile photo of chenghao
    chenghao

    We are now spending a whole days trying to install xenomai on our dragonboard 410c just follow the hiki methods.Unfortunately,we encountered many problems.We are eagering to know if there are a specific instructions targeted for 410c.Thank you!

    • Profile photo of ldts
      ldts

      the procedure is just the same but with different branches.

      1. install the release
      2. replace the kernel with the ipipe patched kernel.
      3. install the xenomai libraries.

      After that you should be ready to go.

      may I suggest that you use the 96boards forum to post the issues you are encountering and I will help you getting your board ready this week.

      • Profile photo of ldts
        ldts

        by the way if you use this commit for the gpiopwn driver
        http://git.xenomai.org/xenomai-jro.git/commit/?h=next-devel

        and this tool:
        https://github.com/ldts/servo-udp

        you can use the arrow-keys of a network connected machine to control the servo motors connected to your Dragon/HiKey boards.

        • Profile photo of chenghao
          chenghao

          Thank you! In fact,I install kernel locally.After using “make install” in linux.git , I find that 410c don’t replace the kernel with the ipipe patched kernel . Moreover,grub dosen’t exist on 410c, I installed grub and try to replace the kernel but failed again

          • Profile photo of chenghao
            chenghao

            PS:when “make install” in linux.git, “cp:cannot stat ‘/etc/modprobe.d’ No such file or directory”

          • Profile photo of ldts
            ldts

            follow these instructions with the ipipe enabled kernel to create a new bootimage.
            for any other question, please do use the forum

      • Profile photo of chenghao
        chenghao

        Thanks for your guide!We will try as you have said,and hope to communicate with you in the future!

        • Profile photo of chenghao
          chenghao

          Thank you for your guide!However,Everything has been prepared except how to established cross-compiler environment on the server(my server is ubuntu),which I failed many times.It is also a problem how to compile it.

          • Profile photo of chenghao
            chenghao

            We have submit our probolem on the forum you mentioned.Could you please go there and help me with it?Thank you!

Leave a Comment