Summary of the invention
Technical problem to be solved by this invention is to provide a kind of information gathering of ectoskeleton power-assisting robot and the method for designing of control system, to realize running state monitoring and the power-assisted to human body of exoskeleton robot, solve the existing sensor information acquisition problems of existing exoskeleton robot, energy Real-time Collection effective information, thus robot is precisely controlled.
The present invention is achieved through the following technical solutions:
The exoskeleton robot frame for movement that improves human locomotion ability is to take the symmetrical structure that waist center is axle, it comprises the servo-actuated waist support with 4 degree of freedom, waist support is connected with hip joint driving device by support, Thigh bone connecting rod is connected knee joint driving device with elevating mechanism with hip joint driving device, elevating mechanism can extend and shorten for the height differences of different human body; Ankle arthrosis top is connected with focile connecting rod, in side, is connected with vola pedal, can realize pedal and take rotating freely that ankle arthrosis center is axle.In the junction of pedal middle, vola, be leaf spring, the bending of forefoot when adaptation people foot is walked.When people steps on this pedal, normally walk, the ground of feeling to coexist is walked the same.
The information acquisition system of ectoskeleton power-assisting robot is independent of outside frame for movement, comprise the gyroscope that is positioned at waist support middle part, the rotary encoder of hip joint drive motors, Thigh bone connecting rod middle part acceleration transducer, the rotary encoder of knee joint drive motors, focile connecting rod middle part acceleration transducer and be installed on the pressure transducer on the pedal of vola.According to the function of the frame for movement of ectoskeleton power-assisting robot and sensor, pressure transducer is installed to the sole place of left and right bipod, and in conjunction with human biology and kinematics analysis, they are arranged on to each main stress point, finally, by calculating average force, judge on this basis human motion intention and walking posture.4 acceleration transducers, are used for detecting acceleration and the rotational angle of robot leg exercise, for judging people's walking posture and later stage prediction walking intention, make it more effective to the power-assisted of human body.Gyroscope in the middle of after waist can carry out the measurement of center of gravity, prevents the injury that robot falls and causes.In addition, the rotary encoder data that also need to gather drive motors are for judging that whether the operation conditions of motor meets control requirement, conveniently accurately controls.According to the distributing position of sensor and dense degree, system is carried out data acquisition and preliminary treatment with single-chip microcomputer independently respectively, and adopts zigbee wireless communication mode to carry out transfer of data, sends data to host computer and processes.The upper computer software of being write by VC++ can show the state that human body is started to walk, walked, stops, and carries out real-time update, and upper function is carried out control strategy adjustment according to user training progress simultaneously.
The control system of ectoskeleton power-assisting robot comprises servomotor and the motor driver that install respectively at hip joint, knee joint place, and motor is controlled by motor driver, can accurately control its position and speed, and can measure and feed back.According to data that information acquisition system obtains and analysis result, the CAN bus in this servo-control system in microcontroller is sent instruction to motor driver, and corresponding motor is controlled, and reaches the effect of assisted walk.
The invention has the beneficial effects as follows: this robot can collect the effective information of various sensors in the mode of wireless transmission, greatly facilitate the action of human body and the Real-time Collection of information.According to the information collecting, can analyze human body moving situation and judgement human motion intention, by control system, the frame for movement of exoskeleton robot is controlled, and carry out the adjustment of speed and position according to the degree of human body recovery training, make patient can adapt to gradually each section of rehabilitation training.Thereby be familiar with the gait of walking, improve human locomotion ability and Health restoration.
The specific embodiment
In order to make the object, technical solutions and advantages of the present invention clearer, below in conjunction with the drawings and specific embodiments, describe the present invention.
The specific implementation of ectoskeleton power-assisting robot is provided in the embodiment of the present invention, it is to take the symmetrical structure that waist center is axle, Fig. 1 is the integral mechanical structure schematic diagram in the embodiment of the present invention, it comprises the servo-actuated waist support 1 with 4 degree of freedom, by bandage, waist support 1 and human body waist are linked together, can realize servo-actuated with human body waist movement.Waist support is connected with hip joint driving device 3 by support, Thigh bone connecting rod 4 is connected knee joint driving device 6 with elevating mechanism 5 with hip joint driving device 3, by being arranged on the adjusting elevating mechanism 5 on Thigh bone connecting rod 4, the people that can adapt to different heights is wearing this lower limb exoskeleton power-assisting robot.Articulated driving equipment the 3, the 6th, motor is connected with whole joint by motor shaft, controls the rotation in joint, for motion provides power.The stay bolt simultaneously installing additional by locating hole outside is realized spacing between two support movements, meets human body lower limbs physiological movement feature, for lower extremity movement provides limit protection.Ankle arthrosis 8 tops are connected with focile connecting rod 7, in side, are connected with vola pedal 9, can realize pedal 9 and take rotating freely that ankle arthrosis 8 centers are axle.In the junction of vola pedal 9 middles, be leaf spring, the bending of forefoot when adaptation people foot is walked.When people dresses this exoskeleton robot by bandage, people's lower limb are exactly an integral body with it.Bi-pedal is normally walked on this pedal, and the ground of feeling to coexist is walked the same.
Be arranged on the accurate perception human body motion track of sensor meeting in this robot simultaneously, thereby control, be arranged on hip joint and kneed motor, drive the motion of lower limb to realize power-assisted.
Fig. 2 is the data acquisition and controlling system schematic in the embodiment of the present invention, as shown in Figure 2, comprises the following aspects:
1, the various kinds of sensors of collection ectoskeleton power-assisting robot information
Degree of will speed up installation of sensors is in the thigh and calf centre position 10,12 of left and right lower limb, and the relevant position of symmetrical leg, carries out the measurement of acceleration of motion.Adopting sensor is herein ADXL345, this sensor is by the acceleration of 3 directions of 3 axle sensing unit inductions, then by electronic induction device, the amount of acceleration sensing is changed into analog quantity, analog quantity is converted to the laggard row digital filtering of digital quantity and is stored in FIFO through ADC, and wait main equipment is read the value of acceleration by control and interrupt logic from serial i/O mouth.The injury of falling and causing when preventing that people from walking, is arranged on centre position after waist by gyroscope 2, carries out the measurement of center of gravity.The rotary encoder OMORONE6B2-CWZ6C that is arranged on respective drive motor place can gather the information such as the speed of service of motor and position, after information gathering is entered to controller, just can judge whether the operation conditions of motor meets control requirement.
By pressure transducer be arranged on as shown in Figure 3 14,15,16,17, via kinesiology and biological comprehensive analysis, these 4 the main stress points of sole while moving for people, therefore at this setting pressure sensor FSR402 everywhere, for measuring plantar pressure changing value.The pressure bearing when pressure transducer is larger, and resistance value is less, is changed to magnitude of voltage through change-over circuit, then by after signal conditioning circuit by signals collecting in controller, carry out calculation of pressure, finally can obtain average force by appropriate algorithm.
2. part of data acquisition
According to the distributing position of sensor and collection demand, by 5 single chip computer AT mega128, sensor is carried out to data acquisition.By after various kinds of sensors and single-chip microcomputer exact connect ion, write correct program and can collect corresponding data, because so the difference signal type of sensor is different, be divided into two kinds of digital quantity and analog quantitys, analogue signal becomes after digital quantity by the AD translation interface on single-chip microcomputer, and data preliminary treatment and transmission are carried out in single-chip microcomputer unification.
3. tcp data segment
Single-chip microcomputer is after collecting sensing data, by with zigbee wireless transport module from the correct line of node, can by the sensor digital data transmission previously having collected to zigbee module from node, and then transfer on zigbee host node by the mode of wireless transmission.In view of the control node of exoskeleton robot is more single, and all nodal informations are all aggregated into the host node on PC, so adopt Star Network transmission.Host node is connected by serial ports with PC, receive after information host node can be accurately the information transmission to host computer.
4. data analysis and demonstration
The data of the zigbee host node transmission receiving by serial ports, can obtain each sensor values, are representing state and the machine operation situation of partes corporis humani position.After the suitable date processing of host computer, utilize VC++ software development environment to write function code and graphic user interface to host computer, can be by the data analysis human body collecting current walking state and rehabilitation training situation, to the control of later stage exoskeleton robot, play a part very important.The interface of upper computer software as shown in Figure 4.
5. the control of pair frame for movement
The control system of ectoskeleton power-assisting robot adopts AT90CAN128 controller with CAN mouth as core, by the total line traffic control of CAN, be arranged on the motor driver above frame for movement, and then by the running of driver control motor, realize the power-assisted of exoskeleton robot.And can carry out the adjustment of control strategy according to the training condition of different human body and rehabilitation progress.
This exoskeleton robot work process is as follows; First by rehabilitation therapist Jiang Ci robot, by bandage type structure, be worn on a patients body, according to different rehabilitation trainings, carry out the change of control program.The training program at rehabilitation initial stage is generally the fixedly gait of program setting, and human body basic is servo-actuated action.After adaptive training after a while, human body can carry out self-service action, and then the artificial follower of this machine after the data acquisition and analysis by information acquisition system, is formulated control program human body is carried out to power-assisted.Through this repetition training, help patient to strengthen walking ability, reach rehabilitation efficacy.
Therefore, a kind of ectoskeleton power-assisting robot information gathering in the present invention and control system can be utilized the information such as the moving situation, self-position of this power-assisting robot of multiple sensors Real-time Collection, by mechanical mechanism being driven by servomotor after data analysis, thereby realize the Based Intelligent Control to exoskeleton robot, to ectoskeleton, follow-up study has important reference value.
The foregoing is only preferred embodiment of the present invention, in order to limit the present invention, within the spirit and principles in the present invention not all, any modification of making, be equal to replacement, improvement etc., within all should being included in the scope of protection of the invention.