Screw driving device
According to the present invention, an axial force of a screw which is generated by screw driving is estimated. A control part applies a predetermined torque generated by a rotation axis servomotor to a screw in a rotation direction where a screw is driven, and thereafter releases the torque. The control part then estimates an axial force of the driven screw based on fluctuation of a rotation position of the rotation axis servomotor which occurs due to the release of the torque.
1. A screw driving device comprising:
driver bit, configured to rotate a screw;
a first motor, configured to drive the driver bit to rotate; and
controller, configured to control the first motor,
wherein the controller is configured to:
apply a predetermined torque generated by the first motor to the screw in a rotation direction where the screw is driven, then perform a step of releasing the torque, wherein
at a start of the step of releasing the torque, the controller is configured to acquire a first rotation angle of a rotation axis of the first motor, and
at an end of the step of releasing the torque, the controller is configured to acquire a second rotation angle of the rotation axis of the first motor; and
determine an axial force of the driven screw based on a change of a rotation position of the first motor in the step of releasing the torque, wherein the axial force is along a direction of the rotation axis.
2. The screw driving device according to claim 1 , further comprising a second motor controlled by the controller for moving the driver bit in an axial direction,
wherein the controller performs:
a first step of screwing the screw into a screw hole, wherein the first motor is set at a predetermined rotation speed and the driver bit is moved by the second motor until the torque generated by the first motor reaches a threshold torque; and
a second step of increasing the torque generated by the first motor until the torque reaches the predetermined torque for full driving of the screw.
3. The screw driving device according to claim 2 , wherein the controller is configured to determine the axial force by reflecting variations in a torque of the second motor in the first step.
4. The screw driving device according to claim 3 , wherein the controller is configured to determine the axial force by reflecting an average value of the rotation speed of the first motor in the second step.
5. The screw driving device according to claim 4 , wherein the controller is configured to determine a state of driving of the screw is a normal state or an abnormal state based on a change in a position of the driver bit caused by the second motor in the second step and the determined axial force.
6. The screw driving device according to claim 3 , wherein the controller is configured to determine the axial force by reflecting any one of a time of the second step, a standard deviation of a rotation position of the first motor in the second step, a standard deviation of a rotation speed of the first motor, an average of the torque of the first motor, and a range of positions of the driver bit by the second motor.
7. The screw driving device according to claim 6 , wherein the controller is configured to determine a state of driving of the screw is a normal state or an abnormal state based on a change in a position of the driver bit caused by the second motor in the second step and the determined axial force.
8. The screw driving device according to claim 3 , wherein the controller is configured to determine a state of driving of the screw is a normal state or an abnormal state based on a change in a position of the driver bit caused by the second motor in the second step and the determined axial force.
9. The screw driving device according to claim 2 , wherein the controller is configured to determine the axial force by reflecting any one of an average position of the driver bit by the second motor, a time of the first step, an average rotation position of the first motor, a standard deviation of a rotation position of the first motor, an average rotation speed of the first motor and a standard deviation of a rotation speed of the first motor in the first step.
10. The screw driving device according to claim 9 , wherein the controller is configured to determine the axial force by reflecting an average value of the rotation speed of the first motor in the second step.
11. The screw driving device according to claim 10 , wherein the controller is configured to determine a state of driving of the screw is a normal state or an abnormal state based on a change in a position of the driver bit caused by the second motor in the second step and the determined axial force.
12. The screw driving device according to claim 9 , wherein the controller is configured to determine the axial force by reflecting any one of a time of the second step, a standard deviation of a rotation position of the first motor in the second step, a standard deviation of a rotation speed of the first motor, an average of the torque of the first motor, and a range of positions of the driver bit by the second motor.
13. The screw driving device according to claim 9 , wherein the controller is configured to determine a state of driving of the screw is a normal state or an abnormal state based on a change in a position of the driver bit caused by the second motor in the second step and the determined axial force.
14. The screw driving device according to claim 2 , wherein the controller is configured to determine the axial force by reflecting an average value of the rotation speed of the first motor in the second step.
15. The screw driving device according to claim 14 , wherein the controller is configured to determine a state of driving of the screw is a normal state or an abnormal state based on a change in a position of the driver bit caused by the second motor in the second step and the determined axial force.
16. The screw driving device according to claim 2 , wherein the controller is configured to determine the axial force by reflecting any one of a time of the second step, a standard deviation of a rotation position of the first motor in the second step, a standard deviation of a rotation speed of the first motor, an average of the torque of the first motor, and a range of positions of the driver bit by the second motor.
17. The screw driving device according to claim 16 , wherein the controller is configured to determine a state of driving of the screw is a normal state or an abnormal state based on a change in a position of the driver bit caused by the second motor in the second step and the determined axial force.
18. The screw driving device according to claim 2 , wherein the controller is configured to determine a state of driving of the screw is a normal state or an abnormal state based on a change in a position of the driver bit caused by the second motor in the second step and the estimated determined axial force.
19. The screw driving device according to claim 18 , wherein the controller is configured to determine a state of the driving of the screw based on a score obtained by applying an isolation forest to the change in the position of the driver bit caused by the second motor in the second step and the determined axial force.
20. The screw driving device according to claim 1 , wherein the controller performs a step of maintaining the predetermined torque for a predetermined period of time just prior to the step of releasing the torque.