     
   if(millis() > nextcall2){
     nextcall2 += intervalperiod;
-    Serial.println(readJoystick());
-  }
-  on_off ? set_position = xh + sin(10.0f*2.0f*M_PI*millis()/64000.0f) : force = 0;
+    Serial.print(readJoystick());
+    Serial.print(" ");
+    Serial.println(xh);
+  }
+  on_off ? set_position = xh + amplitude * sin(vibrationfrequency*2.0f*M_PI*millis()/64000.0f) : force = 0;
   motorControl();
   
 }

  } else if (fbEvent.startsWith("HitCar")) {
	//TODO rendering
  } else if (fbEvent.startsWith("Creak")) {
	static bool fb = false;
	fb = !fb;
	digitalWrite(feedbackLEDPin, fb);//XXX debug
	//TODO rendering
  } else if (fbEvent.startsWith("Smash")) {
	//TODO rendering
  } else if (fbEvent.startsWith("Wreck")) {

	byte result = 0;
	digitalRead(joyFwdPin) == LOW ? result += 1 : 0;
	digitalRead(joyBackPin) == LOW ? result += 2 : 0;
	//(xh>2.0f) == LOW ? result += 4 : 0;
	//(xh<-2.0f) == LOW ? result += 8 : 0;
	//digitalRead(joyFirePin) == LOW ? result += 16 : 0;
	return result;
}
