#ifndef _KINEMATICS_
#define _KINEMATICS_

#define _USE_MATH_DEFINES

#include <cmath>
#include <vector>
#include <iostream>

#define LINK1 4
#define LINK2 7
#define LINK3 12

//#include "opencv2/opencv.hpp"

float deg2rad(float angle);

float rad2deg(float angle);

std::vector<float> computeForwardKinematics(float q1, float q2, float q3, float L1, float L2, float L3);

std::vector<float> computeInverseKinematics(float x, float y, float z, float L1, float L2, float L3);

/*std::vector<float> computeDifferentialKinematics(float q1, float q2, float q3, float L1, float L2, float L3);

int computeJacobianMatrixRank(std::vector<float> vJacobianMatrix, float threshold);

cv::Mat  computeInverseJacobianMatrix(std::vector<float> vJacobianMatrix);
*/
#endif