mirror of
https://github.com/eclipse/upm.git
synced 2025-12-15 13:26:07 +03:00
adafruitms1438: Initial implementation
The library implements support for the Adafruit MotorShield 1438: http://www.adafruit.com/products/1438 This shield supports 4 DC motors or 2 Stepper motors. It makes use of the pca9685 UPM library, and therefore requires that PR #123 and PR #134 are merged first: PR 123: pkgconfig.in: allow a module to specify dependencies on another module PR 134: pca9685: Initial implementation Signed-off-by: Jon Trulson <jtrulson@ics.com> Signed-off-by: Zion Orent <zorent@ics.com> Signed-off-by: Mihai Tudor Panu <mihai.tudor.panu@intel.com>
This commit is contained in:
committed by
Mihai Tudor Panu
parent
2aa24162c3
commit
da0071ae71
244
src/adafruitms1438/adafruitms1438.h
Normal file
244
src/adafruitms1438/adafruitms1438.h
Normal file
@@ -0,0 +1,244 @@
|
||||
/*
|
||||
* Author: Jon Trulson <jtrulson@ics.com>
|
||||
* Copyright (c) 2015 Intel Corporation.
|
||||
*
|
||||
* Permission is hereby granted, free of charge, to any person obtaining
|
||||
* a copy of this software and associated documentation files (the
|
||||
* "Software"), to deal in the Software without restriction, including
|
||||
* without limitation the rights to use, copy, modify, merge, publish,
|
||||
* distribute, sublicense, and/or sell copies of the Software, and to
|
||||
* permit persons to whom the Software is furnished to do so, subject to
|
||||
* the following conditions:
|
||||
*
|
||||
* The above copyright notice and this permission notice shall be
|
||||
* included in all copies or substantial portions of the Software.
|
||||
*
|
||||
* THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
|
||||
* EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
|
||||
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
|
||||
* NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE
|
||||
* LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION
|
||||
* OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION
|
||||
* WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE.
|
||||
*/
|
||||
#pragma once
|
||||
|
||||
#include <stdint.h>
|
||||
#include <sys/time.h>
|
||||
|
||||
#include <string>
|
||||
#include <mraa/i2c.h>
|
||||
#include <mraa/gpio.h>
|
||||
|
||||
#include "pca9685.h"
|
||||
|
||||
#define ADAFRUITMS1438_I2C_BUS 0
|
||||
#define ADAFRUITMS1438_DEFAULT_I2C_ADDR 0x60
|
||||
|
||||
namespace upm {
|
||||
|
||||
/**
|
||||
* @brief UPM module for the Adafruit Motor Shield 1438
|
||||
* @defgroup adafruitms1438 libupm-adafruitms1438
|
||||
*/
|
||||
|
||||
/**
|
||||
* @brief C++ API for the ADAFRUITMS1438 motor shield
|
||||
*
|
||||
* This class implements support for the stepper and DC motors that
|
||||
* can be connected to this Motor Shield.
|
||||
* http://www.adafruit.com/products/1438
|
||||
*
|
||||
* NOTE: The two servo connections are not actually controlled by
|
||||
* the pca9685 controller (or this class), rather they are connected
|
||||
* directly to digital PWM pins 9 and 10 on the arduino breakout.
|
||||
*
|
||||
* @ingroup i2c adafruitms1438
|
||||
* An example using a DC motor conected to M3
|
||||
* @snippet adafruitms1438.cxx Interesting
|
||||
* An example using a stepper motor connected to M1 & M2
|
||||
* @snippet adafruitms1438-stepper.cxx Interesting
|
||||
*/
|
||||
class AdafruitMS1438 {
|
||||
public:
|
||||
|
||||
/**
|
||||
* Enum to specify the direction of a motor
|
||||
*/
|
||||
typedef enum {
|
||||
DIR_NONE = 0x00,
|
||||
DIR_CW = 0x01,
|
||||
DIR_CCW = 0x02
|
||||
} DIRECTION_T;
|
||||
|
||||
/**
|
||||
* Enum to specify a DC motor
|
||||
*/
|
||||
typedef enum {
|
||||
MOTOR_M1 = 0,
|
||||
MOTOR_M2 = 1,
|
||||
MOTOR_M3 = 2,
|
||||
MOTOR_M4 = 3
|
||||
} DCMOTORS_T;
|
||||
|
||||
/**
|
||||
* Enum to specify a Stepper motor
|
||||
*/
|
||||
typedef enum {
|
||||
STEPMOTOR_M12 = 0,
|
||||
STEPMOTOR_M34 = 1
|
||||
} STEPMOTORS_T;
|
||||
|
||||
/**
|
||||
* AdafruitMS1438 constructor
|
||||
*
|
||||
* @param bus i2c bus to use
|
||||
* @param address the address for this sensor
|
||||
*/
|
||||
AdafruitMS1438(int bus, uint8_t address = ADAFRUITMS1438_DEFAULT_I2C_ADDR);
|
||||
|
||||
/**
|
||||
* AdafruitMS1438 Destructor
|
||||
*/
|
||||
~AdafruitMS1438();
|
||||
|
||||
/**
|
||||
* Return the number of milliseconds elapsed since initClock(...)
|
||||
* was last called.
|
||||
*
|
||||
* @return elapsed milliseconds
|
||||
*/
|
||||
uint32_t getMillis(STEPMOTORS_T motor);
|
||||
|
||||
/**
|
||||
* Reset the Clock
|
||||
*
|
||||
*/
|
||||
void initClock(STEPMOTORS_T motor);
|
||||
|
||||
/**
|
||||
* Set the PWM period. Note this applies to all PWM channels.
|
||||
*
|
||||
* @param hz set the PWM period
|
||||
*/
|
||||
void setPWMPeriod(float hz);
|
||||
|
||||
/**
|
||||
* enable PWM output for a motor
|
||||
*
|
||||
* @param motor the DC motor to enable
|
||||
*/
|
||||
void enableMotor(DCMOTORS_T motor);
|
||||
|
||||
/**
|
||||
* disable PWM output for a motor
|
||||
*
|
||||
* @param motor the DC motor to disable
|
||||
*/
|
||||
void disableMotor(DCMOTORS_T motor);
|
||||
|
||||
/**
|
||||
* enable output for a stepper motor
|
||||
*
|
||||
* @param motor the stepper motor to enable
|
||||
*/
|
||||
void enableStepper(STEPMOTORS_T motor);
|
||||
|
||||
/**
|
||||
* disable output for a stepper motor
|
||||
*
|
||||
* @param motor the stepper motor to disable
|
||||
*/
|
||||
void disableStepper(STEPMOTORS_T motor);
|
||||
|
||||
/**
|
||||
* set the speed of a DC motor. Values can range from 0 (off) to
|
||||
* 100 (full speed).
|
||||
*
|
||||
* @param motor the DC motor to configure
|
||||
* @param speed speed to set the motor to
|
||||
*/
|
||||
void setMotorSpeed(DCMOTORS_T motor, int speed);
|
||||
|
||||
/**
|
||||
* set the speed of a stepper in revolution per minute (RPM)
|
||||
*
|
||||
* @param motor the DC motor to configure
|
||||
* @param speed speed to set the motor to
|
||||
*/
|
||||
void setStepperSpeed(STEPMOTORS_T motor, int speed);
|
||||
|
||||
/**
|
||||
* set the direction of a DC motor, clockwise or counter clockwise
|
||||
*
|
||||
* @param motor the DC motor to configure
|
||||
* @param dir direction to set the motor to
|
||||
*/
|
||||
void setMotorDirection(DCMOTORS_T motor, DIRECTION_T dir);
|
||||
|
||||
/**
|
||||
* set the direction of a stepper motor, clockwise or counter clockwise
|
||||
*
|
||||
* @param motor the stepper motor to configure
|
||||
* @param dir direction to set the motor to
|
||||
*/
|
||||
void setStepperDirection(STEPMOTORS_T motor, DIRECTION_T dir);
|
||||
|
||||
/**
|
||||
* set a stepper motor configuration
|
||||
*
|
||||
* @param motor the stepper motor to configure
|
||||
* @param stepsPerRev the number of step to complete a full revolution
|
||||
*/
|
||||
void stepConfig(STEPMOTORS_T motor, unsigned int stepsPerRev);
|
||||
|
||||
/**
|
||||
* step a stepper motor a specified number of steps
|
||||
*
|
||||
* @param motor the stepper motor to step
|
||||
* @param steps number of steps to move the stepper motor
|
||||
*/
|
||||
void stepperSteps(STEPMOTORS_T motor, unsigned int steps);
|
||||
|
||||
private:
|
||||
// SWIG will generate warning for these 'nested structs', however
|
||||
// those can be ignored as these structs are never exposed.
|
||||
|
||||
// struct to hold mappings of the dc motors
|
||||
typedef struct {
|
||||
int pwm;
|
||||
int in1;
|
||||
int in2;
|
||||
} DC_PINMAP_T;
|
||||
|
||||
// struct to hold mappings of the stepper motors
|
||||
typedef struct {
|
||||
int pwmA;
|
||||
int in1A;
|
||||
int in2A;
|
||||
int pwmB;
|
||||
int in1B;
|
||||
int in2B;
|
||||
} STEPPER_PINMAP_T;
|
||||
|
||||
// struct to hold some information about each stepper
|
||||
typedef struct {
|
||||
int stepsPerRev; // steps per revolution
|
||||
int currentStep; // current step number
|
||||
uint32_t stepDelay; // delay between steps
|
||||
int stepDirection; // direction to step
|
||||
struct timeval startTime; // starting time
|
||||
} STEPPER_CONFIG_T;
|
||||
|
||||
void setupPinMaps();
|
||||
void stepperStep(STEPMOTORS_T motor);
|
||||
|
||||
DC_PINMAP_T m_dcMotors[4];
|
||||
STEPPER_PINMAP_T m_stepMotors[2];
|
||||
STEPPER_CONFIG_T m_stepConfig[2];
|
||||
|
||||
PCA9685 *m_pca9685;
|
||||
};
|
||||
}
|
||||
|
||||
|
||||
Reference in New Issue
Block a user