2martens/uni
1
0
Fork 0
mirror of https://github.com/2martens/uni.git synced 2026-05-06 11:26:25 +02:00
Code Releases Activity

[ES] Finished 3.5

Browse Source 
Signed-óff-by: Jim Martens <github@2martens.de>
This commit is contained in:
Jim Martens
2015-05-29 18:51:07 +02:00
parent 05ecd361b3
commit 04805ce189
1 changed files with 12 additions and 8 deletions
Download Patch File Download Diff File Expand all files Collapse all files

20
es/blatt3/uebung3-5/uebung3-5.ino
View File

@ -26,9 +26,9 @@ bool volatile read_ready = false;
/** /**
* Validates the new servo position. * Validates the new servo position.
* *
* @param int newServoPos * @param long newServoPos
*/ */
int validate_new_servo_pos(int newServoPos) { int validate_new_servo_pos(long newServoPos) {
if (newServoPos > 159) { if (newServoPos > 159) {
newServoPos = 159; newServoPos = 159;
@ -42,7 +42,9 @@ int validate_new_servo_pos(int newServoPos) {
lightLED = true; lightLED = true;
} }
return newServoPos; int validatedServoPos = (int) newServoPos;
return validatedServoPos;
} }
/** /**
@ -50,11 +52,13 @@ int validate_new_servo_pos(int newServoPos) {
* *
* @param char command * @param char command
*/ */
int parse_angle(char* command) { long parse_angle(char* command) {
// get position of ( and extract string until position of ) char* angle;
char angle[5];
return (int) angle; angle = strtok(command, "()");
angle = strtok(NULL, "()");
return strtol(angle, NULL, 10);
} }
/** /**
@ -91,7 +95,7 @@ void loop() {
} }
command[i] = '\0'; command[i] = '\0';
int servoPos = parse_angle(command); long servoPos = parse_angle(command);
int validatedServoPos = validate_new_servo_pos(servoPos); int validatedServoPos = validate_new_servo_pos(servoPos);
ourServo.write(validatedServoPos); ourServo.write(validatedServoPos);