Added comments and set up dumping to different directories based on color
Added comments and set up dumping to different directories based on color

RoboticsClubatUCF/RoboSub,RoboticsClubatUCF/RoboSub,RoboticsClubatUCF/RoboSub,RoboticsClubatUCF/RoboSub