Raspberries/upm
Public Access
2
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

uln200xa: C implementation and examples

Browse Source 
Signed-off-by: Jon Trulson <jtrulson@ics.com>
This commit is contained in:
Jon Trulson
2016-10-24 16:04:51 -06:00
parent 7e0862cecc
commit 58dfa9d95a
14 changed files with 499 additions and 270 deletions
Download Patch File Download Diff File Expand all files Collapse all files

208
src/uln200xa/uln200xa.cxx
View File

@@ -1,6 +1,6 @@
/*
* Author: Jon Trulson <jtrulson@ics.com>
* Copyright (c) 2015 Intel Corporation.
* Copyright (c) 2015-2016 Intel Corporation.
*
* Permission is hereby granted, free of charge, to any person obtaining
* a copy of this software and associated documentation files (the
@@ -31,218 +31,36 @@
using namespace upm;
using namespace std;
ULN200XA::ULN200XA(int stepsPerRev, int i1, int i2, int i3, int i4)
ULN200XA::ULN200XA(int stepsPerRev, unsigned int i1, unsigned int i2,
unsigned int i3, unsigned int i4) :
m_uln200xa(uln200xa_init(stepsPerRev, i1, i2, i3, i4))
{
m_stepsPerRev = stepsPerRev;
m_currentStep = 0;
m_stepDelay = 0;
m_stepDirection = 1; // default is forward
if ( !(m_stepI1 = mraa_gpio_init(i1)) )
{
throw std::invalid_argument(std::string(__FUNCTION__) +
": mraa_gpio_init(i1) failed, invalid pin?");
return;
}
mraa_gpio_dir(m_stepI1, MRAA_GPIO_OUT);
if ( !(m_stepI2 = mraa_gpio_init(i2)) )
{
throw std::invalid_argument(std::string(__FUNCTION__) +
": mraa_gpio_init(i2) failed, invalid pin?");
mraa_gpio_close(m_stepI1);
return;
}
mraa_gpio_dir(m_stepI2, MRAA_GPIO_OUT);
if ( !(m_stepI3 = mraa_gpio_init(i3)) )
{
throw std::invalid_argument(std::string(__FUNCTION__) +
": mraa_gpio_init(i3) failed, invalid pin?");
mraa_gpio_close(m_stepI1);
mraa_gpio_close(m_stepI2);
return;
}
mraa_gpio_dir(m_stepI3, MRAA_GPIO_OUT);
if ( !(m_stepI4 = mraa_gpio_init(i4)) )
{
throw std::invalid_argument(std::string(__FUNCTION__) +
": mraa_gpio_init(i4) failed, invalid pin?");
mraa_gpio_close(m_stepI1);
mraa_gpio_close(m_stepI2);
mraa_gpio_close(m_stepI3);
return;
}
mraa_gpio_dir(m_stepI4, MRAA_GPIO_OUT);
// set default speed to 1
setSpeed(1);
if (!m_uln200xa)
throw std::runtime_error(std::string(__FUNCTION__) +
": uln200xa_init() failed");
}
void ULN200XA::initClock()
{
gettimeofday(&m_startTime, NULL);
}
uint32_t ULN200XA::getMillis()
{
struct timeval elapsed, now;
uint32_t elapse;
// get current time
gettimeofday(&now, NULL);
// compute the delta since m_startTime
if( (elapsed.tv_usec = now.tv_usec - m_startTime.tv_usec) < 0 )
{
elapsed.tv_usec += 1000000;
elapsed.tv_sec = now.tv_sec - m_startTime.tv_sec - 1;
}
else
{
elapsed.tv_sec = now.tv_sec - m_startTime.tv_sec;
}
elapse = (uint32_t)((elapsed.tv_sec * 1000) + (elapsed.tv_usec / 1000));
// never return 0
if (elapse == 0)
elapse = 1;
return elapse;
}
ULN200XA::~ULN200XA()
{
mraa_gpio_close(m_stepI1);
mraa_gpio_close(m_stepI2);
mraa_gpio_close(m_stepI3);
mraa_gpio_close(m_stepI4);
uln200xa_close(m_uln200xa);
}
void ULN200XA::setSpeed(int speed)
void ULN200XA::setSpeed(unsigned int speed)
{
m_stepDelay = 60 * 1000 / m_stepsPerRev / speed;
uln200xa_set_speed(m_uln200xa, speed);
}
void ULN200XA::setDirection(ULN200XA_DIRECTION_T dir)
{
switch (dir)
{
case DIR_CW:
m_stepDirection = 1;
break;
case DIR_CCW:
m_stepDirection = -1;
break;
}
}
void ULN200XA::stepperStep()
{
int step = m_currentStep % 8;
// This motor requires a different sequencing order in 8-steps than
// usual.
// Step I0 I1 I2 I3
// 1 0 0 0 1
// 2 0 0 1 1
// 3 0 0 1 0
// 4 0 1 1 0
// 5 0 1 0 0
// 6 1 1 0 0
// 7 1 0 0 0
// 8 1 0 0 1
switch (step)
{
case 0: // 0001
mraa_gpio_write(m_stepI1, 0);
mraa_gpio_write(m_stepI2, 0);
mraa_gpio_write(m_stepI3, 0);
mraa_gpio_write(m_stepI4, 1);
break;
case 1: // 0011
mraa_gpio_write(m_stepI1, 0);
mraa_gpio_write(m_stepI2, 0);
mraa_gpio_write(m_stepI3, 1);
mraa_gpio_write(m_stepI4, 1);
break;
case 2: // 0010
mraa_gpio_write(m_stepI1, 0);
mraa_gpio_write(m_stepI2, 0);
mraa_gpio_write(m_stepI3, 1);
mraa_gpio_write(m_stepI4, 0);
break;
case 3: // 0110
mraa_gpio_write(m_stepI1, 0);
mraa_gpio_write(m_stepI2, 1);
mraa_gpio_write(m_stepI3, 1);
mraa_gpio_write(m_stepI4, 0);
break;
case 4: // 0100
mraa_gpio_write(m_stepI1, 0);
mraa_gpio_write(m_stepI2, 1);
mraa_gpio_write(m_stepI3, 0);
mraa_gpio_write(m_stepI4, 0);
break;
case 5: // 1100
mraa_gpio_write(m_stepI1, 1);
mraa_gpio_write(m_stepI2, 1);
mraa_gpio_write(m_stepI3, 0);
mraa_gpio_write(m_stepI4, 0);
break;
case 6: // 1000
mraa_gpio_write(m_stepI1, 1);
mraa_gpio_write(m_stepI2, 0);
mraa_gpio_write(m_stepI3, 0);
mraa_gpio_write(m_stepI4, 0);
break;
case 7: // 1001
mraa_gpio_write(m_stepI1, 1);
mraa_gpio_write(m_stepI2, 0);
mraa_gpio_write(m_stepI3, 0);
mraa_gpio_write(m_stepI4, 1);
break;
}
uln200xa_set_direction(m_uln200xa, dir);
}
void ULN200XA::stepperSteps(unsigned int steps)
{
while (steps > 0)
{
if (getMillis() >= m_stepDelay)
{
// reset the clock
initClock();
m_currentStep += m_stepDirection;
if (m_stepDirection == 1)
{
if (m_currentStep >= m_stepsPerRev)
m_currentStep = 0;
}
else
{
if (m_currentStep <= 0)
m_currentStep = m_stepsPerRev;
}
steps--;
stepperStep();
}
}
uln200xa_stepper_steps(m_uln200xa, steps);
}
void ULN200XA::release()
{
mraa_gpio_write(m_stepI1, 0);
mraa_gpio_write(m_stepI2, 0);
mraa_gpio_write(m_stepI3, 0);
mraa_gpio_write(m_stepI4, 0);
uln200xa_release(m_uln200xa);
}