UVic Assistive Technology Lab / Mbed 2 deprecated DSLR_Camera_Gimbal

Dependencies:   mbed ros_lib_kinetic

gimbal.cpp

Committer:
MikeGray92
Date:
2018-03-05
Revision:
4:89ebfa37663b
Parent:
3:527f0b949839
Child:
6:2ffa254e8f6e

File content as of revision 4:89ebfa37663b:


#include <stdint.h>
#include "mbed.h"
#include <ros.h>
#include <std_msgs/Empty.h>
#include <std_msgs/Float32MultiArray.h>
#include <BNO055.h>
#include <initializations.h>
#include <definitions.h>
#include <prototypes.h>
#include <Mx28.h>

static int i = 0;

void runGimbal(void){
        switch(i){
            case(0):
            gimbal.servo(YAWID, control.yaw, 30);
            i++;
            break;
            case(1): 
            gimbal.servo(PITCHID, control.pitch, 30);
            i++;
            break;
            case(2):
            gimbal.servo(ROLLID, control.roll, 30);
            i = 0;
            break;
        }                           
}