34 #ifndef __HUMANOID_CONTROL_FUNCTIONS_H_
35 #define __HUMANOID_CONTROL_FUNCTIONS_H_
41 #include <Eigen/Dense>
44 #define PATH_FOLLOWING_POSITION_ERROR 1 //double
types.h file for this module. Contains types and structures used by the application.
void UpdateArmsDirKinData(shared_vars_t *RobotVars)
Function to update the arm end point.
void UpdateKinematicModelDirKin(shared_vars_t *RobotVars)
Function to update shared structure with the current direct kinematic of the robot.
double ConvertServoValueByID(int id, short unsigned int servo_value)
Function to convert a servo value for a given humanoid servo ID.
void DemoUserPath_WritePoints(shared_vars_t *RobotVars)
Function to write points to file.
void PathFollowingExecute(shared_vars_t *RobotVars)
Function to run points read from file.
Shared struture that holds robot/device information.
void ArmsDifferencialSpeedControl(double *avg_speed, shared_vars_t *RobotVars)
Main robot arm speed control type function.
void SetArmSpeed(short int SIDE, short int speed, shared_vars_t *RobotVars)
Function to set speed to arm servos.
void DemoUserPath_ReadPoints(shared_vars_t *RobotVars)
Function to read points from file.
void UpdateJointDataByID(short int id, double joint_angle, shared_vars_t *RobotVars)
Function to update joint value in the data struture from supplied ID.
void CalculateDifferencialArmServoSpeed(double *avg_speed, shared_vars_t *RobotVars)
Function to calculate joint angular speed given 3d space velocity vector.
void SetLegSpeed(short int SIDE, short int speed, shared_vars_t *RobotVars)
Function to set speed to leg servos.
void StopRobotMovement(shared_vars_t *RobotVars)
Function to stop robot at its current joint configuration.
void UpdateDetachedLegsDirKinData(shared_vars_t *RobotVars)
Function to update the detached legs end point.
void SetRobotHomePosition(shared_vars_t *RobotVars)
Function to send commands to set the robot to its home position.
humanoid_functions.h file for this module. Contains includes, prototypes and defines.
miscellaneous.h file for this module. Contains prototypes, includes and defines.
void SetArmAutomaticSpeeds(short int SIDE, shared_vars_t *RobotVars)
Function set different automatic speeds to arm servomotors.
void MoveDetachedLegToCartesianPosition(double X, double Y, double Z, double t4, short int SIDE, shared_vars_t *RobotVars)
Function to move detached leg end point to given coordinates.
short unsigned int ConvertJointAngleByID(int id, double angle_position)
Function to convert a joint angle for a given humanoid servo ID.
void MoveArmToCartesianPosition(double X, double Y, double Z, short int SIDE, shared_vars_t *RobotVars)
Function to move arm end point to given coordinates.