Hi, I have rich experience in Arduino , ATmega Series in C and ASM as well
I understand your Project
Summary
- Locks(I dont know it is ,i has to be screwed and also programmed so i considered it something
to be processed ) moves on a conveyor to a station where 3 screws are screwed
- then to programmer station where it is programmed
- then to testing station where power , battery level are measured and rejected if it is bad
components
- 3 Servomotor (X,Y,Z) are mentioned but T6600 is used which is stepper driver
I dont understand here
- Infrared sensor, sensor lock, I2C IO expander with relays i believe its like resister box which adds resistance when relay on
queries
"Use the internal Chip tension as a calculation level" - Using internal Vref ??
tension - voltage??
I would implement Event driven State machine algorithms which more efficient for embedded system with complex peripherals, name may sound complex, but its easy to understand, nothing but execution based on current state or event
I get the basic Idea of working
But i need more information Contact me if you want