* Replace the fk solver with kdl kinematics
* Resolve the wrong kdl kinematics due to ill robot tree structure
* Apply isort and black and apply some naming changes
* Remove white spaces, blanks
* Change file permission 755 to 644
* Change file permission 755 to 644
* Change file permission 755 to 644
* Change file permission 755 to 644
* Change file permission 644 to 755