with the tof code

Dependencies:   mbed Servo ros_lib_kinetic

Motors/Motor.h

Committer:
Stumi
Date:
2019-11-12
Revision:
6:2cc2aac35868
Parent:
4:36a04230554d
Child:
7:8248af58df5a

File content as of revision 6:2cc2aac35868:

/*--------------------------------------------------------------------------------
Filename: TOF.h
Description: Header file for adafruit VL_6180X TOF sensor
--------------------------------------------------------------------------------*/
#ifndef MOTOR_H
#define MOTOR_H

#include "mbed.h"
#include "Buzzer.h"
#include "LED.h"

/*--------------------------------------------------------------------------------
---------------------------------DEFINES------------------------------------------
--------------------------------------------------------------------------------*/

//MOTOR 1
#define M1_IN1  PC_6
#define M1_IN2  PB_15
#define M1_PWM  PB_13
#define M1_A    PA_4
#define M1_B    PB_12

//MOTOR 2
#define M2_IN1  PA_15
#define M2_IN2  PC_7
#define M2_PWM  PB_4
#define M2_A    PB_5
#define M2_B    PB_3

/*--------------------------------------------------------------------------------
---------------------------------CLASSES------------------------------------------
--------------------------------------------------------------------------------*/

// Class for managing connection and state to a VL6180X sensor

class cMotor
{
public:
    cMotor(PwmOut pwm, DigitalOut fwd, DigitalOut rev);  //Constructor, initialised motor pinouts
    void Forwards(float speed);
    void Backwards(float speed);
    void Stop();
private:
    PwmOut _pwm;
    DigitalOut _fwd;
    DigitalOut _rev;

};

/*--------------------------------------------------------------------------------
-----------------------------------Functions---------------------------------------
--------------------------------------------------------------------------------*/
void Check_for_obstacles(uint8_t TOFRange[4]); //Obstacle avoidance functionality

/*--------------------------------------------------------------------------------
--------------------------------External Variables--------------------------------
--------------------------------------------------------------------------------*/
//extern cMotor MotorL;  //Left motor class and pin initialisation
//extern cMotor MotorR;  //Right motor class and pin initialisation

#endif