Updated visualizer and correct mistake from Mathematical Model
Added visualizer and correct mistake from mathematical model of robot
Merged repo's