Added PWM Frequency Changer

Code part from here: http://playground.arduino.cc/Code/PwmFrequency

Author: gajdipajti

ldc500/ldc500.ino

@@ -33,9 +33,30 @@ const int dht22Pin =  8;
 String inputString = "";         // a string to hold incoming data
 boolean stringComplete = false;  // whether the string is complete
 
+// Change PWM Frequency for Timer2.
+// Copied the relevant part from here:
+// http://playground.arduino.cc/Code/PwmFrequency
+void setPwmFrequency(int pin, int divisor) {
+  byte mode;
+  if(pin == 3 || pin == 11) {
+    switch(divisor) {
+      case 1: mode = 0x01; break;
+      case 8: mode = 0x02; break;
+      case 32: mode = 0x03; break;
+      case 64: mode = 0x04; break;
+      case 128: mode = 0x05; break;
+      case 256: mode = 0x06; break;
+      case 1024: mode = 0x7; break;
+      default: return;
+    }
+    TCCR2B = TCCR2B & 0b11111000 | mode;
+  }
+}
+
 void setup() {
   pinMode(laserREM, OUTPUT);
   pinMode(laserMod, OUTPUT);
+  setPwmFrequency(laserMod, 1);
   Serial.begin(115200);
   // reserve 200 bytes for the inputString:
   inputString.reserve(200);