Sonntag, 20. Januar 2019

Nicht ich, sondern der Boden bewegt sich (MonoGame)


Für die Lösung, wie eine Figur auf der Karte Bewegt werden kann, ist davon abhängig, wieviel Leistung mein Ziel System hat. In den meisten Fällen hat man mehr als genügend Leistung, so dass man sich hierbei entscheiden kann. Für relativ schwache System, z.B. wie bei einem Arduino Esplora kann eine Figur auf dem Bildschirm bewegt werden, ohne einem starken flackern. Eine Karte auf dem Bildschirm zu bewegen sieht dagegen wieder schlecht aus, weil der Bildaufbau zu lange dauert. Und das bei einer Auflösung von 128x160 Pixeln.

Nicht die Figur, sondern die Karte bewegt sich
Nun zurück zum Eigentlichen. Die Figur ist immer mittig auf dem Bildschirm und bewegt sich auf einer Karte. Aber Technisch gesehen, wird die Karte bewegt und die Figur hat eine Laufanimation.

Neues MonoGame Projekt
Aktuell wird für dieses Beispiel eine Neue Solution angelegt mit dem Ziel einer UWP Anwendung. Die Zielplattform und Version hat jedoch keinen Effekt für das Beispiel. Der Grund für UWP ist, das die Lauffähigkeit auf PC, Tablet, Raspberry Pi 2&3 und wenn ich mich nicht irre, auch auf der Xbox funktionieren soll. Sollte die Anwendung/Spiel auch auf dem Windows Phone laufen, dann ist eine ältere Minimum Ziel Version von Windows 10 einzustellen.



Ordnung ist das halbe Leben
Als erstes brauchen wir eine Projekt Struktur und legen ein paar Ordner an. Components wird es später drei Komponenten geben, die für die Benutzereingaben, die Karteverarbeitung und das Zeichnen zuständig sind.





















Der Umfang für das Realisieren benötigt einige Zeilen Code, so das eine Aufteilung der Inhalte Notwendig sind. Deshalb kann zunächst in der 'Game1.cs' fast alles weg. Nur der Konstruktor bleibt.

 using Microsoft.Xna.Framework;  
 namespace ExampleWalkingOnMap  
 {  
   public class Game1 : Game  
   {  
     private GraphicsDeviceManager _graphics;  
     public Game1()  
     {  
       this._graphics = new GraphicsDeviceManager(this);  
       this.Content.RootDirectory = "Content";  
       this.Window.Title = "Example Walking on map";  
       this.IsMouseVisible = true;  
     }  
   }  
 } 

Eingabegerät
Für das erfassen von Tasteneingaben, wird die Klasse 'ComponentInputs.cs' und für die Steuerinformation 'InputData.cs' angelegt.








Zunächst muss die 'InputData.cs' bearbeitet werden, um die verarbeiteten Steuerinformationen weiter zutragen.

 using Microsoft.Xna.Framework;  
 namespace ExampleWalkingOnMap.Components.Inputs  
 {  
   public class InputData  
   {  
     public Vector2 Move => new Vector2(this.MoveX, this.MoveY);  
     public float MoveX { get; set; }  
     public float MoveY { get; set; }  
   }  
 } 

Mit der ‚InputData‘ können die Eingaben in ComponentInputs.cs aufgenommen werden. Im Beispiel wird die Tastatur und ein Xbox Controller eingelesen. Damit wäre die Eingabe Komponente fertig.

using Microsoft.Xna.Framework;  
 using Microsoft.Xna.Framework.Input;  
 using System;  
 namespace ExampleWalkingOnMap.Components.Inputs  
 {  
   public class ComponentInputs : GameComponent  
   {  
     public InputData Inputs { get; private set; } = new InputData();  
     public ComponentInputs(Game game) : base(game) {  }  
     public override void Update(GameTime gameTime)  
     {  
       this.Inputs.MoveX = 0;  
       this.Inputs.MoveY = 0;  
       KeyboardState stateKeyboard = Keyboard.GetState();  
       this.Inputs.MoveX += stateKeyboard.IsKeyDown(Keys.A) ? 1 : 0;  
       this.Inputs.MoveX -= stateKeyboard.IsKeyDown(Keys.D) ? 1 : 0;  
       this.Inputs.MoveY += stateKeyboard.IsKeyDown(Keys.W) ? 1 : 0;  
       this.Inputs.MoveY -= stateKeyboard.IsKeyDown(Keys.S) ? 1 : 0;  
       GamePadState stateGamePad = GamePad.GetState(PlayerIndex.One);  
       this.Inputs.MoveX += stateGamePad.ThumbSticks.Left.X * -1;  
       this.Inputs.MoveY += stateGamePad.ThumbSticks.Left.Y;  
       // Normalize  
       this.Inputs.MoveX = Math.Min(1, Math.Max(-1, this.Inputs.MoveX));  
       this.Inputs.MoveY = Math.Min(1, Math.Max(-1, this.Inputs.MoveY));  
     }  
   }  
 }

Die Karte
Die Realisierung der Karte wird in Kacheln unterteilt und ist auch relativ leicht um zusetzten. Jede Kachel hat eine eigene Position und eine Textur, womit schon mal das nächste Objekt definiert ist.





















Für die Textur mit verschiedenen Untergründen wird eine Bilddatei zusammen gefasst, die die Unterschiedlichen Bodentexturen beinhaltet. Jedes Objekt kennt dann nur den Ausschnitt aus der Bilddatei. Für das Beispiel verwende ich die Texturen von https://kenney.nl/assets.











Im Projekt wurde bereits mit der Vorlage, der Ordner 'Content' angelegt. Hier wird nun die Textur abgelegt.






Nun muss die Bilddatei noch mit dem Pipline Tool verarbeitet werden, indem ihr doppelkick auf 'Content.mgcb' ausführt. Im Ausschnitt Projekt wird die Bilddatei hinzugefügt.
















Wirkt leider etwas doppelt, aber dies ist notwendig, damit die Textur später im Programmcode geladen werden kann.

















Anschließend auf den Button 'Build' oder F6 drücken und fertig ist dieser Teil und könnt das Tool  wieder schließen.















Nun zurück zum Code für die Kachel Information. Wie bereits erwähnt, kennt die Kachel nur die Position der Textur, die später über die Methode Draw hinein gereicht wird. Mit dem weiteren Parameter 'offset' wird bestimmt, wo im Fenster gerendert wird.

using Microsoft.Xna.Framework;  
 using Microsoft.Xna.Framework.Graphics;  
 namespace ExampleWalkingOnMap.Components.Map  
 {  
   public class GroundTile  
   {  
     private Rectangle _texturePosition;  
     public GroundTile(int x, int y, int width, int height)  
     {  
       this._texturePosition = new Rectangle(x, y, width, height);  
     }  
     public void Draw(Texture2D textureMapTiles, SpriteBatch spriteBatch, Vector2 offset)  
     {  
       spriteBatch.Draw(textureMapTiles,  
                offset,  
                this._texturePosition,  
                Color.White,  
                0f,  
                new Vector2(0, 0),  
                new Vector2(1, 1),  
                SpriteEffects.None,  
                0f);  
     }  
   }  
 } 

Die Karte soll aus 10x10 Kacheln bestehen und wird in einer Hilfsklasse erstellt.






Mit dem zwei Dimensionalen Integer Array, lässt sich visuell schnell eine Karte dieser Größe  zusammenstellen, die wiederum noch übersichtlich ist. Zumindest im ersten Abschnitt der Methode. Anschließend wird hier in das Ziel Array gemappt mit den eigentlichen Ziel Objekt.

using System;  
 namespace ExampleWalkingOnMap.Components.Map  
 {  
   internal class MapHelper  
   {  
     internal static GroundTile[,] CreateMap()  
     {  
       int[][] map = new int[10][];  
       map[0] = new int[10] { 0, 0, 0, 0, 0, 0, 0, 0, 2, 2 };  
       map[1] = new int[10] { 0, 0, 0, 0, 0, 0, 0, 0, 2, 2 };  
       map[2] = new int[10] { 1, 1, 1, 1, 1, 1, 1, 0, 2, 2 };  
       map[3] = new int[10] { 0, 0, 0, 0, 0, 0, 1, 0, 2, 2 };  
       map[4] = new int[10] { 0, 0, 0, 0, 0, 0, 1, 0, 2, 2 };  
       map[5] = new int[10] { 0, 0, 0, 0, 0, 0, 1, 0, 2, 2 };  
       map[6] = new int[10] { 0, 0, 0, 0, 0, 0, 1, 0, 2, 2 };  
       map[7] = new int[10] { 0, 0, 0, 0, 0, 0, 1, 0, 0, 0 };  
       map[8] = new int[10] { 0, 0, 0, 0, 0, 0, 1, 0, 3, 3 };  
       map[9] = new int[10] { 0, 0, 0, 0, 0, 0, 1, 0, 3, 0 };  
       GroundTile[,] groundTiles = new GroundTile[10, 10];  
       for (int iY = 0; iY < 10; iY++)  
       {  
         for (int iX = 0; iX < 10; iX++)  
         {  
           groundTiles[iY, iX] = GetMappingGroundTile(map[iY][iX]);  
         }  
       }  
       return groundTiles;  
     }  
     private static GroundTile GetMappingGroundTile(int groundTile)  
     {  
       switch (groundTile)  
       {  
         case 0:  
           return new GroundTile(0, 0, 64, 64);  
         case 1:  
           return new GroundTile(64, 0, 64, 64);  
         case 2:  
           return new GroundTile(0, 64, 64, 64);  
         case 3:  
           return new GroundTile(64, 64, 64, 64);  
       }  
       throw new ArgumentException("groundTile can be only 0, 1, 2 and 3");  
     }  
   }  
 }  

Für die Verwaltung der Karte wird die Klasse 'ComponentMap.cs' erstellt. Dort werden die Karteninhalte gesteuert und gehalten.






Der Umfang der Klasse ist hier größer als bei den anderen, auch wenn dessen Ausführung sehr klein gehalten ist.

using ExampleWalkingOnMap.Components.Inputs;  
 using Microsoft.Xna.Framework;  
 using Microsoft.Xna.Framework.Graphics;  
 namespace ExampleWalkingOnMap.Components.Map  
 {  
   public class ComponentMap : GameComponent  
   {  
     private readonly ComponentInputs _inputs;  
     private GroundTile[,] _mapTiles;  
     private Texture2D _textureMapTiles;  
     private int _mapTileWidth, _mapTileHeight;  
     private Vector2 _screenOffset, _movePosition;  
     public Vector2 Position => new Vector2(this._movePosition.X + this._screenOffset.X,  
                         this._movePosition.Y + this._screenOffset.Y);  
     private int _mapWidth, _mapHeight;  
     public ComponentMap(Game game, ComponentInputs inputs) : base(game) => this._inputs = inputs;  
     internal void SetScreenOffset(float screenWidth, float screenHeight)  
     {  
       var centerScreenWidth = screenWidth / 2;  
       var centerScreenHeight = screenHeight / 2;  
       this._screenOffset = new Vector2(centerScreenWidth, centerScreenHeight);  
       this._movePosition = new Vector2(0, 0);  
     }  
     public override void Initialize()  
     {  
       using (var stream = TitleContainer.OpenStream("Content/MapTiles.png"))  
       {  
         this._textureMapTiles = Texture2D.FromStream(this.Game.GraphicsDevice, stream);  
       }  
       this._mapTiles = MapHelper.CreateMap();  
       this._mapTileWidth = this._textureMapTiles.Width / 2;  
       this._mapTileHeight = this._textureMapTiles.Height / 2;  
       this._mapWidth = this._mapTileWidth * this._mapTiles.GetLength(0);  
       this._mapHeight = this._mapTileHeight * this._mapTiles.GetLength(1);  
     }  
     public override void Update(GameTime gameTime)  
     {  
       this._movePosition += this._inputs.Inputs.Move * 2f;  
     }  
     public void DrawMapTiles(SpriteBatch spriteBatch)  
     {  
       for (int iY = 0; iY < this._mapTiles.GetLength(0); iY++)  
       {  
         for (int iX = 0; iX < this._mapTiles.GetLength(1); iX++)  
         {  
           Vector2 textureOffset = new Vector2(iX * this._mapTileWidth, iY * this._mapTileHeight);  
           Vector2 offset = this.Position + textureOffset;  
           this._mapTiles[iY, iX].Draw(this._textureMapTiles, spriteBatch, offset);  
         }  
       }  
     }  
   }  
 }

In der Update Methode wird die Bewegung mit 2 Multipliziert. Wenn die Bewegung zu langsam erscheint, dann kann hier der Wert erhöht werden. Wie bereits angemerkt, zeigt dieser Teil das Nötigste, um eine Karte anzulegen und für das Rendern vorzubereiten.

Rendern
Am Ende muss die Karte auf dem Bildschirm gerendert werden. Dazu wird noch eine weitere Komponente angelegt mit dem Namen 'ComponentRender.cs'.




Damit die Karte auf die Start Position in die Mitte zentriert wird, wird die Größe des Fensters eingelesen und dessen Werte für den Offset der Karte zugewiesen.

using ExampleWalkingOnMap.Components.Map;  
 using Microsoft.Xna.Framework;  
 using Microsoft.Xna.Framework.Graphics;  
 using Windows.UI.ViewManagement;  
 namespace ExampleWalkingOnMap.Components.Render  
 {  
   public class ComponentRender : DrawableGameComponent  
   {  
     private readonly ComponentMap _componentMap;  
     private SpriteBatch _spriteBatch;  
     public ComponentRender(Game game, ComponentMap componentMap) : base(game)  
     {  
       this._componentMap = componentMap;  
     }  
     public override void Initialize()  
     {  
       this._spriteBatch = new SpriteBatch(this.GraphicsDevice);  
       var screenWidth = (float)ApplicationView.GetForCurrentView().VisibleBounds.Width;  
       var screenHeight = (float)ApplicationView.GetForCurrentView().VisibleBounds.Height;  
       this._componentMap.SetScreenOffset(screenWidth, screenHeight);  
     }  
     public override void Draw(GameTime gameTime)  
     {  
       this.GraphicsDevice.Clear(Color.DarkBlue);  
       this._spriteBatch.Begin();  
       this._componentMap.DrawMapTiles(this._spriteBatch);  
       this._spriteBatch.End();  
     }  
   }  
 }  

Zurück zum Start
Am Ende müssen die Komponenten in die GameComponentCollection hinzugefügt werden, damit die Inhalte ausgeführt werden. Dazu geht es wieder in die 'Game1.cs' Code Datei. Hier werden in den Member die Komponenten eingetragen und im Konstruktor wird die 'UpdateOrder' zugewiesen und schließlich in die Collection aufgenommen.

 using ExampleWalkingOnMap.Components.Inputs;  
 using ExampleWalkingOnMap.Components.Map;  
 using ExampleWalkingOnMap.Components.Render;  
 using Microsoft.Xna.Framework;  
 namespace ExampleWalkingOnMap  
 {  
   public class Game1 : Game  
   {  
     private GraphicsDeviceManager _graphics;  
     private ComponentInputs _componentInputs;  
     private ComponentMap _componentMap;  
     private ComponentRender _componentRender;  
     public Game1()  
     {  
       this._graphics = new GraphicsDeviceManager(this);  
       this.Content.RootDirectory = "Content";  
       this.Window.Title = "Example Walking on map";  
       this.IsMouseVisible = true;  
       this._componentInputs = new ComponentInputs(this);  
       this._componentInputs.UpdateOrder = 1;  
       this.Components.Add(this._componentInputs);  
       this._componentMap = new ComponentMap(this, this._componentInputs);  
       this._componentMap.UpdateOrder = 2;  
       this.Components.Add(this._componentMap);  
       this._componentRender = new ComponentRender(this, this._componentMap);  
       this._componentRender.UpdateOrder = 3;  
       this.Components.Add(this._componentRender);  
     }  
   }  
 }  

Wenn ich hier im Blog-Post keinen Code ausgelassen habe, dann sollte sich die Anwendung starten lassen und die Karte mit den Tasten AWSD sich bewegen lassen. Oder auch mit dem Xbox Controller.



Nachwort
Mit ein wenig mehr Code, kann man dann einige Unreinheiten beheben, wie z.B. die Übergänge von Kachel zu Kachel sehen nicht immer sauber aus oder das der Untergrund Einfluss auf die Laufgeschwindigkeit hat. Und Überhaupt fehlt die Laufende Figur in der Mitte.

Die Anwendung läuft soweit auch auf einem Raspberry Pi mit Windows 10 IoT. Jedoch sollte man keine hohen Performance erwarten, da hier keine DirectX Unterstützung vorhanden ist. Im Folgenden Video zeige ich die Anwendung  auf einem Bildschirm mit einer Eingestellten Auflösung von 640x350 Pixeln (Nativ sind jedoch 480x320). In HD, also 1920x1080p, sind weniger als fünf Bilder pro Sekunde zu erwarten. Zudem ist der Boot Vorgang relativ lang und bis die MonoGame App gestartet ist. Da vergehen schon einige Minuten.
Der Aufbau und das Prinzip funktioniert auch mit Windows Forms, WPF und XAML. Auch wenn diese UI Technologien nicht dafür gedacht sind, kann man sehen zumindest sehen wie Leistungsfähig die anderen sind.

Die fertige Solution habe ich wie immer auf dem GitHub geladen. Zusätzlich sind die meisten Inhalte kommentiert.




Samstag, 13. Oktober 2018

PCA9685 PWM Driver Module mit Rasperry Pi & Win 10 Iot


Was mit dem Netduino geht, geht für gewöhnlich auch auf dem Raspberry Pi (wenn es nicht gerade um PWM Ausgänge geht). Grundsätzlich hatte ich das Modul tatsächlich für den Rasperry Pi gekauft, um die Fehlende Ausgabemöglichkeit eines PWM Signal auszugleichen. Zwar kann man einen Pin so programmieren, dass ein PWM Signal erzeugt wird, aber ich fand dieses Lösung zunächst nicht sehr ansprechend.

Benötigt:
  • Raspberry Pi 2 oder 3
  • 8GB SD Karte mit installierten Windows 10 IoT
  • Mindestens ein Servo zum Testen
  • Externe Spannungsquelle mit Maximal 6V


UWP Anwendung erstellen
Nam dem anlegen einer neuen Solution wird für den Zugriff auf die Schnittstelle I²C die Reference "Windows IoT Extensions for the UWP" hinzugefügt. Das Beispiel geht mit allen Version die für Windows 10 IoT und Raspberry Pi.


Fast identisch
Außer der Zugriff auf das Interface für I²C, ist der Aufruf gleich. Das Konfigurieren der Schnittstelle erfolgt z.B. nicht im Konstruktor, sondern in einer eigenen Initialisierungsmethode. Grund hierfür ist das abrufen der Instanz von I2cDevice das über die DeviceInformation abgeholt werden kann.

internal class Pca9685 {

private readonly byte _address = 0x40;
private readonly byte PCA9685_MODE1 = 0x00;
private readonly byte PCA9685_PRESCALE = 0xFE;
private readonly byte LED0_ON_L = 0x06;
private readonly byte LED0_ON_H = 0x07;
private readonly byte LED0_OFF_L = 0x08;
private readonly byte LED0_OFF_H = 0x09;

private I2cDevice _i2cDevice;

public Pca9685(int period) : base()
{
    this._period = period * 1000;
}

private async Task Init()
{
    var i2cSettting = new I2cConnectionSettings(this._address);
    i2cSettting.BusSpeed = I2cBusSpeed.StandardMode;

    var deviceSelector = I2cDevice.GetDeviceSelector();

    var deviceInfo = await DeviceInformation.FindAllAsync(deviceSelector);
    this._i2cDevice = await I2cDevice.FromIdAsync(deviceInfo[0].Id, i2cSettting);

    if (this._i2cDevice == null)
    {
        throw new Exception("i2cDevice is null");
    }
}
…

Zudem sind alle Methodenaufrufe Asynchron. Die Lösung ist auch in Synchron möglich, jedoch denke ich, dass die Verwendung von Async, Await und Task noch im Übersichtlichen Rahmen ist.
Allerdings muss man sich bewusst machen, obwohl die Methoden Asynchron ausgeführt werden können, müssen die Aufrufe nacheinander erfolgen. Überschneiden oder gleichzeitig ist Technisch für die Schnittstelle nicht möglich, weil die Bits nacheinander geschrieben werden können.

…
public async Task Reset()
{
    if(!this.Write(new byte[] { this.PCA9685_MODE1, 0x00 }))
    {
        throw new Exception("Can not send the reset command.");
    }

    await Task.Delay(10);
}

internal async Task Start()
{
    await this.Init();

    int hz = 1000000 / this._period;

    await this.Reset();
    await this.SetPwmFrequency(hz);
}

public async Task SetPwmFrequency(float frequency)
{
    byte prescale = this.GetPrescale(frequency);

    byte[] buffer = new byte[1] { this.PCA9685_MODE1 };

    if (!this.Read(buffer))
    {
        throw new Exception("can not read mode1");
    }

    byte oldMode = buffer[0];

    // sleep
    byte newMode = (byte)(((byte)oldMode & (byte)0x7F) | (byte)0x10);

    // go to sleep
    this.Write(new byte[] { this.PCA9685_MODE1, newMode });
    this.Write(new byte[] { this.PCA9685_PRESCALE, prescale });
    this.Write(new byte[] { this.PCA9685_MODE1, oldMode });
    await Task.Delay(5);
    this.Write(new byte[] { this.PCA9685_MODE1, (byte)(oldMode | 0x80) });

    byte[] bufferRead = new byte[] { this.PCA9685_MODE1 };
    this.Read(bufferRead);
}
        
internal void SetPwm(byte outputNumber, int on, int off)
{
    byte targetOutput_ON_L = (byte)(this.LED0_ON_L + 4 * outputNumber);
    byte targetOutput_ON_H = (byte)(this.LED0_ON_H + 4 * outputNumber);
    byte targetOutput_OFF_L = (byte)(this.LED0_OFF_L + 4 * outputNumber);
    byte targetOutput_OFF_H = (byte)(this.LED0_OFF_H + 4 * outputNumber);

    this.Write(new byte[] { targetOutput_ON_L, (byte)on });
    this.Write(new byte[] { targetOutput_ON_H, (byte)(on >> 8) });
    this.Write(new byte[] { targetOutput_OFF_L, (byte)(off) });
    this.Write(new byte[] { targetOutput_OFF_H, (byte)(off >> 8) });
}
…

Zur Vollständigkeit kommen noch die restlichen Methoden. Das Umrechnen (GetPrescale) ist hier direkt kopiert und unterscheidet sich auch nicht mal von der C++ Version die in den Sourcecode von Adafruit fand.
Das Versenden der Bytes braucht nicht mehr code als die Netduino Lösung.

…
private byte GetPrescale(float frequency)
{
    frequency *= 0.9f;
    // internal clock frequency
    float prescaleval = 25000000;
    prescaleval /= 4096;
    prescaleval /= frequency;
    prescaleval -= 1;

    return (byte)(prescaleval + 0.5);
}

private bool Write(byte[] buffer)
{
    var result = this._i2cDevice.WritePartial(buffer);

    if (result.Status != I2cTransferStatus.FullTransfer)
    {
        Debug.WriteLine(result.Status);
    }

    return result.Status == I2cTransferStatus.FullTransfer;
}

private bool Read(byte[] buffer)
{
    var result = this._i2cDevice.ReadPartial(buffer);

    if (result.Status != I2cTransferStatus.FullTransfer)
    {
        Debug.WriteLine(result.Status);
    }

    return result.Status == I2cTransferStatus.FullTransfer;
}
}

Kommt mir immer noch verdreht vor
Bereits im Blog Post für das Netduino Beispiel, hatte ich den Eindruck, dass die Ansteuerung verdreht ist. Das Verhalten ist auch hier Identisch.

Verkabeln
Vier Leitungen reichen, um das Modul Anzusteuern. Hier sind keine Besonderheiten. Damit der Angeschlossene Servo zuverlässig reagiert, sollte eine Externe Spannungsquelle angeschlossen werden.

Die Wesentlichen Technischen Infos:
PWM Signal kann in 4096 Stufen gesteuert werden (12Bit)
PWM Signal kann zwischen 24Hz bis maximal 1526Hz eingestellt werden.
Die 16 Anschlüsse für die Stromversorgung der Servos, können maximal betrieben werden in Abhängigkeit der Angeschlossenen Spannungsversorgung.
PWM Output selbst kann maximal bis 25mA verwendet werden für LEDs
Spannungsversorgung für die Steuerung über I²C darf von 2,3V bis 5,5V liegen.
16 PWM Ausgänge
Kann über einen Externen Clock betrieben werden, der maximal bis 50MHz sein darf.
Intern ist ein 25MHz Oszillator verbaut.
Kann für LEDs oder Servos verwendet werden.


Github Quellcode in C++
Datenblatt:


Sonntag, 23. September 2018

PCA9685 PWM Driver Modul mit dem Netduino


Nach etwas längerer Zeit ist eine Thema mit dem Netduino wieder dran. Diesmal ist das PWM Treiber Modul dran, den ich schon etwas länger hier liegen habe und es ist eigentlich zunächst für den Raspberry Pi gedacht, aber da fehlt mir noch eine neue Platine um einen eigenen Motor Treiber zu bauen.

Benötigt wird:
  • Netduino (sollte mit allen Versionen funktionieren)
  • PCA9685 16 Channel PWM Driver (Meins ist nicht von Adafruit)
  • Mindestens ein Servo zum Testen
  • Externe Spannunsquelle mit Maximal 6V


Neues Projekt
Für das Projekt werden die Referenzen Microsoft.SPOT.Hardware und Microsoft.SPOT.Native die für die I²C und Debug Ausgaben verwendet werden. Neben der bestehenden Program.cs Klasse wird eine eigene Klasse für den PWM Treiber hinzugefügt, die dann den Inhalt hat des hier folgenden gezeigten Code. Weitere Kommentare sind im Github Repository zu sehen.

public class Pca9685 : I2CDevice
{
    private readonly byte PCA9685_MODE1 = 0x00;
    private readonly byte PCA9685_PRESCALE = 0xFE;

    private readonly byte LED0_ON_L = 0x06;
    private readonly byte LED0_ON_H = 0x07;

    private readonly byte LED0_OFF_L = 0x08;
    private readonly byte LED0_OFF_H = 0x09;

    private readonly byte ALL_LED_ON_L = 0xFA;
    private readonly byte ALL_LED_ON_H = 0xFB;
       
    private int _period;
       
    public Pca9685(int period) : base(new Configuration(0x40, 100))
    {
        this._period = period * 1000;
    }

    public void Reset()
    {
        this.Write(new byte[]{ PCA9685_MODE1, 0x00 });
        Thread.Sleep(10);
    }

    internal void Start()
    {
        int hz = 1000000 / this._period;

        this.Reset();
        this.SetPwmFrequency(hz);
    }
        
    public void SetPwmFrequency(float frequency)
    {
        frequency *= 0.9f;
        float prescaleval = 25000000;
        prescaleval /= 4096;
        prescaleval /= frequency;
        prescaleval -= 1;

        byte prescale = (byte)(prescaleval + 0.5);

        byte[] buffer = new byte[1] { PCA9685_MODE1 };
           
        if (this.Read(buffer) != 1)
        {
            throw new Exception("can not read mode1");
        }

        byte oldMode = buffer[0];

        byte newMode = (byte)(((byte)oldMode & (byte)0x7F) | (byte)0x10);

        // go to sleep
        this.Write(new byte[] { PCA9685_MODE1, newMode });
        this.Write(new byte[] { PCA9685_PRESCALE, prescale });
        this.Write(new byte[] { PCA9685_MODE1, oldMode });
        Thread.Sleep(5);
        this.Write(new byte[] { PCA9685_MODE1, (byte)(oldMode | 0x80) });

        byte[] bufferRead = new byte[] { PCA9685_MODE1 };
        this.Read(bufferRead);
        Debug.Print("Mode now: " + bufferRead[0].ToString());
    }
       
    internal void SetPwm(byte outputNumber, int on, int off)
    {
        Debug.Print("Output: " + outputNumber.ToString() + ", ON: " + on.ToString() + ", OFF: " + off.ToString());

        byte targetOutput_ON_L = (byte)(LED0_ON_L + 4 * outputNumber);
        byte targetOutput_ON_H = (byte)(LED0_ON_H + 4 * outputNumber);
        byte targetOutput_OFF_L = (byte)(LED0_OFF_L + 4 * outputNumber);
        byte targetOutput_OFF_H = (byte)(LED0_OFF_H + 4 * outputNumber);

        this.Write(new byte[] { targetOutput_ON_L, (byte)on });
        this.Write(new byte[] { targetOutput_ON_H, (byte)(on >> 8) });
        this.Write(new byte[] { targetOutput_OFF_L, (byte)(off) });
        this.Write(new byte[] { targetOutput_OFF_H, (byte)(off >> 8) });
    }

    private int Write(byte[] buffer)
    {
        I2CTransaction[] trans = new I2CTransaction[]
        {
            CreateWriteTransaction(buffer)
        };

        return Execute(trans, 1000);
    }
       
    private int Read(byte[] buffer)
    {
        I2CTransaction[] trans = new I2CTransaction[]
        {
            CreateReadTransaction(buffer)
        };

        return Execute(trans, 1000);
    }
}

Inhalt zur Klasse
Mit der Fertigstellung der Klasse, bzw. ist diese jetzt soweit ausgeführt, dass die einzelnen PWM Ausgänge des Moduls über die I²C gesteuert werden können. Sieht man in das Datenblatt, dann ist zusehen, dass das Modul noch ein paar mehr Sachen kann. Zum einen bin ich hier nicht auf das Kaskadieren des Moduls mit mehreren nicht eingegangen. Dazu komme ich auf ein anderes mal, wenn ich mehrere Module davon besitze.
Der Programmcode selbst habe ich ursprünglich aus öffentlichen C++ Programmcode entnommen und habe deshalb auch die selben Namen für Methoden verwendet wie aus dem Adafruit Programmcode.

Vielleicht verdreht
An der Stelle für SetPwm bin ich mir noch nicht sicher ob die Ansteuerung so richtig ist. Zugegeben, ich bin noch nicht mit dem Datenblatt durch. Da ich selbst weis, wie ein PWM Signal auszusehen hat, sollte auch die Ansteuerung meiner Vorstellung entsprechen. Doch wenn ich den High Puls festlege, dann ist dieser länger als der Low Puls Länge Inherhalb der Periode. Das sollte eigentlich umgekehrt sein.

Verkabeln
Mit vier Leitungen ist das Modul vom Netduino steuerbar. Damit aber auch die Servos später versorgt sind, muss in der Mitte ebenfalls eine Spannungsquelle angeschlossen werden.


Probleme
Falls ihr die Stromversorgung in der Mitte vom Modul mit dem 5V Ausgang vom Netduino versorgt, kann es sein, dass es nicht funktioniert oder instabil reagiert. Bedeutet, kann funktionieren, muss aber nicht. Besser ist immer eine seperate Versorgung anzuschließen. Allein je nach größe des verwendeten Servos und dessen Belastung, könnte die Stromaufnahme zu groß sein (Leider konnte ich keine Information finden, wieviel Strom maximal am 5V Pin abgenommen werden kann vom Netduino).

Die Wesentlichen Technischen Infos:
PWM Signal kann in 4096 Stufen gesteuert werden (12Bit)
PWM Signal kann zwischen 24Hz bis maximal 1526Hz eingestellt werden.
Die 16 Anschlüsse für die Stromversorgung der Servos, können maximal betrieben werden in Abhängigkeit der Angeschlossenen Spannungsversorgung.
PWM Output selbst kann maximal bis 25mA verwendet werden für LEDs
Spannungsversorgung für die Steuerung über I²C darf von 2,3V bis 5,5V liegen.
16 PWM Ausgänge
Kann über einen Externen Clock betrieben werden, der maximal bis 50MHz sein darf.
Intern ist ein 25MHz Ozillator verbaut.
Kann für LEDs oder Servos verwendet werden.


Quellenangaben:
Github Quellcode in C++
Datenblatt:



Sonntag, 22. Juli 2018

Arduino Motor Driver Shield auf Raspberry Pi


Mit einem Expansion Board für Raspberry Pi können die Shields für Arduino verwendet werden. In diesen Beispiel wird ein Motor Shield verwendet, zu dem ich bereits zwei Blog Einträge geschrieben habe. In dem Beispiel mit dem Netduino ist nur die Programmiersprache gleich, aber das verwendete Framework unterscheidet sich stark von einander. Allein schon das Konfigurieren eines Pins für den Raspberry Pi geht vollständig einen anderen Weg. Offen gestanden bin ich wohl an der Stelle konservativ und würde eher im dot Net Umfeld das .NET Micro Framework bevorzugen.

Benötigte Hardware:

  • Raspberry Pi 2 oder 3
  • Waveshare ARPI600 IO Expansion Board
  • Arduino MotorShield mit L293D

Windows IoT Extensions
Mit dem Anlegen einer neuen Solution als Universal Application oder kurz gesagt UWP, muss zunächst die Reference Windows IoT Extensions hinzugefügt werden. Je nach Ziel Version von Windows IoT kann die aktuelle passende Bibliothek hinzugefügt werden. Mit dieser werden dann Klassen bereit gestellt, mit dem der Zugriff auf die GPIOs möglich ist.



Neue MotorShield Klasse anlegen
Den Aufbau der Klasse ist fast wie aus dem Beispiel mit dem Netduino. Die öffentlichen Methoden sind die gleichen. Nur intern musste das Initialisieren der Hardware Pins anders gelöst werden. (Motor Treiber für Rover (.NETMF))
Für mich verwunderlich war, dass es keine PWM Ansteuerung gab oder ich habe das einfach übersehen. Zumindest nach kurzer Suche kamen keine passenden Ergebnisse, wie man die GPIOs mit einem PWM Signal ansteuert. Daher nur Digitales Gas geben.

Anzusteuernde Pins
Im Netz sind Zahlreiche Bilder, die die Pins beschreiben. Auf Waveshare (https://www.waveshare.com/wiki/ARPI600) sind die Pins ebenfalls beschrieben, allerdings ist das auf der Erweiterung anders gekennzeichnet. Hier war es nicht immer schlüssig, ob der Hardware Pin oder GPIO Pin gemeint ist. Am Ende habe ich festgestellt, dass man die Pin Ansicht von Raspberry Pi benötigt und dann auf dem ARPI600 die Beschriftung ablesen und vergleichen musste, um auf das richtige Mapping zu kommen.


Die folgende Tabelle zeigt, mit welchen Bezeichnungen man zu tun hat und wie diese zu einander passen.

Raspberry Pin
Raspberry GPIO
ARPI600
Arduino
MotorShield
8
UARTTO TX
P_RX
D0

10
UARTTO RX
P_TX
D1

11
17
P0
D2

12
18
P1
D3
M2
13
27
P2
D4
Clock
15
22
P3
D5
M4
16
23
P4
D6
M3
18
24
P5
D7
Enable Shiftregister
22
25
P6
D8
Data
7
4
P7
D9

24
8
CE0
D10

19
10
MOSI
D11
M1
21
9
MISO
D12
Latch
23
11
SCK
D13


Verhältnismäßigkeit
Abgesehen der fehlenden Stufenlosen Regeln der Motoren, ist die Steuerung nicht anders als mit einem Arduino oder Netduino. Um nur den Motor Treiber zu verwenden, ist das verwenden mit einem Raspberry Pi gerade zu übertrieben. Selbst mit dem Raspberry Pi 3 und Windows 10 IoT dauerte der Bootvorgang ca. eine Minute, bis dann endlich der Motor Treiber ausgeführt wird. Das relativiert sich dann jedoch, wenn man weitere Funktionalitäten implementiert.


Ameisen Simulation und andere Dinge

Wer lange sich schon mit C# beschäftig, hat sicherlich schon mal was von AntMe gelesen oder gehört. Diese Idee hatte ich aufgegriffen und mi...