|
@@ -22,30 +22,119 @@
|
|
|
|
|
|
|
|
}
|
|
}
|
|
|
*/
|
|
*/
|
|
|
-void P5__TASK__PW(
|
|
|
|
|
|
|
+void P5__TASK__PWM(
|
|
|
P5__TASK__CONFIG_T* P5__TASK__CONFIG_A,
|
|
P5__TASK__CONFIG_T* P5__TASK__CONFIG_A,
|
|
|
P5__TASK__CONFIG__INDEX__CURRENT_T &P5__TASK__CONFIG__INDEX__CURRENT_A ,
|
|
P5__TASK__CONFIG__INDEX__CURRENT_T &P5__TASK__CONFIG__INDEX__CURRENT_A ,
|
|
|
|
|
+ P5__TASK__CONFIG__INDEX__CURRENT__EXEC_T &P5__TASK__CONFIG__INDEX__CURRENT__EXEC_A ,
|
|
|
|
|
|
|
|
P5__TASK__ATTR_T* P5__TASK__ATTR_A,
|
|
P5__TASK__ATTR_T* P5__TASK__ATTR_A,
|
|
|
- P5__TASK__ATTR__INDEX__CURRENT_T &P5__TASK__ATTR__INDEX__CURRENT_A
|
|
|
|
|
- // P5__TASK__TYPE__CLASS_T P5__TASK__TYPE__CLASS_A,
|
|
|
|
|
|
|
+ P5__TASK__ATTR__INDEX__CURRENT_T &P5__TASK__ATTR__INDEX__CURRENT_A ,
|
|
|
|
|
+ P5__TASK__ATTR__INDEX__CURRENT__EXEC_T &P5__TASK__ATTR__INDEX__CURRENT__EXEC_A ,
|
|
|
|
|
+ P5__LATENCY_TASK_EXEC_TIME_T &P5__LATENCY_TASK_EXEC_TIME_A
|
|
|
|
|
+
|
|
|
|
|
+ // P5__TASK__TYPE__CLASS_T P5__TASK__TYPE__CLASS_A,
|
|
|
// P5__TASK__CONFIG__NAME__INDEX_T P5__TASK__CONFIG__NAME__INDEX_A,
|
|
// P5__TASK__CONFIG__NAME__INDEX_T P5__TASK__CONFIG__NAME__INDEX_A,
|
|
|
// P5__TASK__TYPE__ASSOC_T P5__TASK__TYPE__ASSOC_A
|
|
// P5__TASK__TYPE__ASSOC_T P5__TASK__TYPE__ASSOC_A
|
|
|
) {
|
|
) {
|
|
|
- //P5__TASK__CONFIG__NAME__ATTRIBUTE__STATUS__OUTPUT__LEVEL_A
|
|
|
|
|
- /* analogWrite(P5__PWM__PIN__CONF,
|
|
|
|
|
- P5__TASK___ATTR (
|
|
|
|
|
|
|
+ // P5__TASK__CONFIG__NAME__ATTRIBUTE__STATUS__OUTPUT__LEVEL_A
|
|
|
|
|
+ int P5__TASK___ATTR_R = P5__TASK___ATTR (
|
|
|
P5__TASK__CONFIG_A,
|
|
P5__TASK__CONFIG_A,
|
|
|
- P5__TASK__CONFIG__INDEX__CURRENT_A ,
|
|
|
|
|
|
|
+ P5__TASK__CONFIG__INDEX__CURRENT_A ,P5__TASK__CONFIG__INDEX__CURRENT__EXEC_A,
|
|
|
P5__TASK__ATTR_A,
|
|
P5__TASK__ATTR_A,
|
|
|
- P5__TASK__ATTR__INDEX__CURRENT_A ,
|
|
|
|
|
- P5__TASK__TYPE__ATTRIBUTE_A ,
|
|
|
|
|
- P5__TASK__CONFIG__NAME__ATTRIBUTE__STATUS__OUTPUT__LEVEL_A
|
|
|
|
|
- )
|
|
|
|
|
- );
|
|
|
|
|
- */
|
|
|
|
|
- Serial.println("");Serial.print("PW");
|
|
|
|
|
|
|
+ P5__TASK__ATTR__INDEX__CURRENT_A , //5
|
|
|
|
|
+ P5__TASK__ATTR__INDEX__CURRENT__EXEC_A ,//6
|
|
|
|
|
+ P5__TASK__TYPE__ATTRIBUTE_A , //7
|
|
|
|
|
+ P5__TASK__CONFIG__NAME__ATTRIBUTE__STATUS__OUTPUT__LEVEL_A , //8 , //P5__TASK__CONFIG__NAME__INDEX_A, // P5__TASK__TYPE__ATTRIBUTE_A ,
|
|
|
|
|
+
|
|
|
|
|
+ P5__TASK__CONFIG__INDEX__CURRENT__EXEC_A ,//9.5P5__TASK__TYPE__ASSOC_A//
|
|
|
|
|
+ P5__TASK__ATTR_INT__UNDEF_A , // 10 P5__TASK__ATTR_INT_A
|
|
|
|
|
+ P5__TASK__ATTR_ACCTION__SET__INIT_A//11
|
|
|
|
|
+ ) ;
|
|
|
|
|
+ int P5__TASK___ATTR_R_NEW = P5__TASK___ATTR_R ;
|
|
|
|
|
+
|
|
|
|
|
+
|
|
|
|
|
+ P5__TASK__ATTR_INT_T P5__TASK__ATTR_INT_A_SWING_R;
|
|
|
|
|
+ P5__TASK__ATTR_INT_A_SWING_R = P5__TASK___ATTR (
|
|
|
|
|
+ P5__TASK__CONFIG_A,
|
|
|
|
|
+ P5__TASK__CONFIG__INDEX__CURRENT_A ,P5__TASK__CONFIG__INDEX__CURRENT__EXEC_A,
|
|
|
|
|
+ P5__TASK__ATTR_A,
|
|
|
|
|
+ P5__TASK__ATTR__INDEX__CURRENT_A , //5
|
|
|
|
|
+ P5__TASK__ATTR__INDEX__CURRENT__EXEC_A ,//6
|
|
|
|
|
+ P5__TASK__TYPE__ATTRIBUTE_A , //7
|
|
|
|
|
+ P5__TASK__CONFIG__NAME__INDEX__SWING , //8 , //P5__TASK__CONFIG__NAME__INDEX_A, // P5__TASK__TYPE__ATTRIBUTE_A ,
|
|
|
|
|
+
|
|
|
|
|
+ P5__TASK__CONFIG__INDEX__CURRENT__EXEC_A ,//9.5P5__TASK__TYPE__ASSOC_A//
|
|
|
|
|
+ P5__TASK__ATTR_INT__UNDEF_A , // 10 P5__TASK__ATTR_INT_A
|
|
|
|
|
+ P5__TASK__ATTR_ACCTION__REPLY_A // P5__TASK__ATTR_ACCTION__SET__INIT_A//11
|
|
|
|
|
+ ) ;
|
|
|
|
|
+
|
|
|
|
|
+ Serial.print(P5__TASK__ATTR_INT_A_SWING_R);
|
|
|
|
|
+ Serial.print("] ");
|
|
|
|
|
+
|
|
|
|
|
+ //P5__TASK__ATTR_INT_A_SWING_R = P5__TASK__ATTR_INT_A_SWING_R * P5__LATENCY_TASK_EXEC_TIME_A;
|
|
|
|
|
+ if(P5__TASK__ATTR_INT_A_SWING_R != 0) {
|
|
|
|
|
+ if(( P5__TASK___ATTR_R_NEW + (P5__TASK__ATTR_INT_A_SWING_R * P5__LATENCY_TASK_EXEC_TIME_A)) > 255) {
|
|
|
|
|
+ //P5__TASK__ATTR_INT_A_SWING_R = 1;
|
|
|
|
|
+ //set -
|
|
|
|
|
+ Serial.print("["); Serial.print(P5__TASK__ATTR_INT_A_SWING_R); Serial.print(">-]");
|
|
|
|
|
+ P5__TASK___ATTR (
|
|
|
|
|
+ P5__TASK__CONFIG_A, P5__TASK__CONFIG__INDEX__CURRENT_A ,P5__TASK__CONFIG__INDEX__CURRENT__EXEC_A , P5__TASK__ATTR_A,
|
|
|
|
|
+ P5__TASK__ATTR__INDEX__CURRENT_A , P5__TASK__ATTR__INDEX__CURRENT__EXEC_A ,P5__TASK__TYPE__ATTRIBUTE_A ,
|
|
|
|
|
+ P5__TASK__CONFIG__NAME__INDEX__SWING ,
|
|
|
|
|
+ P5__TASK__CONFIG__INDEX__CURRENT__EXEC_A , //9 ref
|
|
|
|
|
+ ( P5__TASK__ATTR_INT_A_SWING_R * - 1 ), //P5__TASK__ATTR_INT_A , // 10 val P5__TASK__ATTR_INT_A
|
|
|
|
|
+ P5__TASK__ATTR_ACCTION__SET_A//11 acction
|
|
|
|
|
+ ) ;
|
|
|
|
|
+ //P5__TASK__ATTR_INT_A_SWING_R = P5__TASK___ATTR_R ;
|
|
|
|
|
+ // P5__TASK___ATTR_R_NEW = P5__TASK___ATTR_R ;
|
|
|
|
|
+ } else if(( P5__TASK___ATTR_R_NEW + (P5__TASK__ATTR_INT_A_SWING_R * P5__LATENCY_TASK_EXEC_TIME_A)) < 1) {
|
|
|
|
|
+ //set -
|
|
|
|
|
+ Serial.print("[<-]");
|
|
|
|
|
+ P5__TASK___ATTR (
|
|
|
|
|
+ P5__TASK__CONFIG_A, P5__TASK__CONFIG__INDEX__CURRENT_A ,P5__TASK__CONFIG__INDEX__CURRENT__EXEC_A , P5__TASK__ATTR_A,
|
|
|
|
|
+ P5__TASK__ATTR__INDEX__CURRENT_A , P5__TASK__ATTR__INDEX__CURRENT__EXEC_A ,P5__TASK__TYPE__ATTRIBUTE_A ,
|
|
|
|
|
+ P5__TASK__CONFIG__NAME__INDEX__SWING ,
|
|
|
|
|
+ P5__TASK__CONFIG__INDEX__CURRENT__EXEC_A , //9 ref
|
|
|
|
|
+ ( P5__TASK__ATTR_INT_A_SWING_R * - 1 ), //P5__TASK__ATTR_INT_A , // 10 val P5__TASK__ATTR_INT_A
|
|
|
|
|
+ P5__TASK__ATTR_ACCTION__SET_A//11 acction
|
|
|
|
|
+ ) ;
|
|
|
|
|
+ //P5__TASK__ATTR_INT_A_SWING_R = P5__TASK___ATTR_R ;
|
|
|
|
|
+ // P5__TASK___ATTR_R_NEW = P5__TASK___ATTR_R ;
|
|
|
|
|
+ } else {
|
|
|
|
|
+ Serial.print("["); Serial.print(P5__TASK___ATTR_R_NEW );
|
|
|
|
|
+ P5__TASK___ATTR_R_NEW = round((P5__TASK__ATTR_INT_A_SWING_R * P5__LATENCY_TASK_EXEC_TIME_A ) + P5__TASK___ATTR_R_NEW) ;
|
|
|
|
|
+ Serial.print(">"); Serial.print(P5__TASK__ATTR_INT_A_SWING_R); Serial.print(">");
|
|
|
|
|
+ Serial.print(P5__TASK___ATTR_R_NEW); Serial.print(">.");
|
|
|
|
|
+ Serial.print(P5__LATENCY_TASK_EXEC_TIME_A); Serial.print(">]");
|
|
|
|
|
+
|
|
|
|
|
+
|
|
|
|
|
+ }
|
|
|
|
|
+ //P5__TASK___ATTR_R =
|
|
|
|
|
+ P5__TASK___ATTR (
|
|
|
|
|
+ P5__TASK__CONFIG_A,
|
|
|
|
|
+ P5__TASK__CONFIG__INDEX__CURRENT_A ,P5__TASK__CONFIG__INDEX__CURRENT__EXEC_A,
|
|
|
|
|
+ P5__TASK__ATTR_A,
|
|
|
|
|
+ P5__TASK__ATTR__INDEX__CURRENT_A , //5
|
|
|
|
|
+ P5__TASK__ATTR__INDEX__CURRENT__EXEC_A ,//6
|
|
|
|
|
+ P5__TASK__TYPE__ATTRIBUTE_A , //7
|
|
|
|
|
+ P5__TASK__CONFIG__NAME__ATTRIBUTE__STATUS__OUTPUT__LEVEL_A , //8 , //P5__TASK__CONFIG__NAME__INDEX_A, // P5__TASK__TYPE__ATTRIBUTE_A ,
|
|
|
|
|
+
|
|
|
|
|
+ P5__TASK__CONFIG__INDEX__CURRENT__EXEC_A ,//9.5P5__TASK__TYPE__ASSOC_A//
|
|
|
|
|
+ P5__TASK___ATTR_R_NEW , //P5__TASK___ATTR_R + P5__TASK__ATTR_INT_A_SWING , // 10 P5__TASK__ATTR_INT_A
|
|
|
|
|
+ P5__TASK__ATTR_ACCTION__SET_A//11
|
|
|
|
|
+ ) ;
|
|
|
|
|
+ analogWrite(P5__PWM__PIN__CONF, P5__TASK___ATTR_R_NEW );
|
|
|
|
|
+ Serial.print(" ~[");
|
|
|
|
|
+ Serial.print(P5__TASK___ATTR_R_NEW );
|
|
|
|
|
+ Serial.print("] ");
|
|
|
|
|
+ } else {
|
|
|
|
|
+ //not swing
|
|
|
|
|
+ analogWrite(P5__PWM__PIN__CONF, P5__TASK___ATTR_R);
|
|
|
|
|
+ Serial.println("");Serial.print("!~[");
|
|
|
|
|
+ Serial.print(P5__TASK___ATTR_R_NEW);Serial.print("](");Serial.print(P5__TASK__ATTR_INT_A_SWING_R);
|
|
|
|
|
+ Serial.print(") ");
|
|
|
|
|
|
|
|
|
|
+ }
|
|
|
}
|
|
}
|
|
|
|
|
|
|
|
#endif
|
|
#endif
|