Test of the Bizchip Servos

Since this time we are using two different kind of servos, thus it is necessary to check the new servos behavior prior to utilising them fully. As such I wrote down the program using PIC to test the Bizchips servos that are used for Base, Wrist, Wrist Rotation and the Gripper.
The reason these four degrees of freedom are chosen is simply because all of them are using a single servo as the mechanism to move.As you can see, I put some remark on S3S4 simply because they are meant for double servos. They would be tested later on since I realized that these Bizchips servos can opened up to more than 180 degree as Futaba S3003. This is meaning that there would be some calculation error for Clockwise and Counter clockwise rotation if I were to use the similar formula with Futaba S3003. As such I will delay the test, and instead I will proceed with the small conveyors installation first.