Apparatus and method for systematic control of robotic deployment and extraction
First Claim
1. A system control apparatus (2000) for systematic control of (i) extraction of a vehicle (100) from an environment, (ii) stowage of the vehicle in a modular handling and stowage system (1000), the system having a primary module (1102) and zero or more secondary modules (1104a-1104n), wherein the secondary modules are serially, mechanically coupled to the primary module and together, and (iii) deployment of the vehicle from the module group in response to command signals, sensor signals, and status signals, the system control apparatus comprising:
- an operator control unit OCU (2012) operated by a User, wherein the OCU generates the command signals as directed by the User, and receives the sensor signals and the status signals;
a modules supervisory controller (2110), a primary individual motor controller (2112_PM), and a primary module sensor suite (1250_PM), wherein, the modules supervisory controller (2110), the primary individual motor controller, and the primary module sensor suite are included in the primary module, wherein,the primary individual motor controller (2112_PM) is electrically coupled to the modules supervisory controller, and the modules supervisory controller and the primary module sensor suite are electrically coupled to the OCU, andthe modules supervisory controller (2110) receives the command signals, the sensor signals and the status signals,the primary individual motor controller (2112_PM) generates one or more of the status signals and receives the command signals,and the primary module sensor suite generates and presents one or more of the sensor signals; and
a secondary individual motor controller (2112a-2112-n) and a secondary module sensor suite (1250a-1250n) that are included in each of the zero or more secondary modules,wherein each of the zero or more secondary modules are electrically coupled to the primary individual motor controller (2112_PM),the secondary individual motor controller (2112a-2112-n) generates one or more of the status signals and receives the command signals, andthe secondary module sensor suite generates and presents one or more of the sensor signals;
wherein,the modules supervisory controller (2110) having a microcontroller that includes state control programming configured as a state machine (4000) to control operation of the primary and the secondary module controllers and the primary and the secondary sensor suites with respect to transition between states, the states including;
UNKNOWN (4102);
UNKNOWN_CLEAR_TO_STOW (4104);
STOWED (4106);
STOWED_CLEAR (4108);
SOLENOID_ACTIVE (4110);
READY_TO_DEPLOY (4120);
DEPLOYED (4122);
DEPLOYED_CLEAR (4124); and
READY_TO_STOW (4126);
wherein, an acknowledgment status signal (ACK) indicates proper receipt of one of the command signals, a non-acknowledgment status signal (NAK) indicates failure to receive one of the command signals, and a SUCCESS condition for the state machine (4000) is defined as receipt of the status signal ACK;
wherein the transition between the states comprises;
starting with one of the primary and the secondary modules at the UNKNOWN state (4102), when the vehicle (100) is not present and the one of the primary and the secondary modules is at either of the STOWED and STOWED_CLEAR states, the state of the one of the primary and the secondary modules autonomously transitions to the UNKNOWN_CLEAR_TO_STOW state (4104);
from the UNKNOWN_CLEAR_TO_STOW state (4104), when the one of the primary and the secondary modules achieves a SUCCESS condition that is defined as receipt of the signal ACK and includes one of the primary and the secondary modules the vehicle (100) in the stowed position, the state of the one of the primary and the secondary modules command-directed transitions to the STOWED state (4106);
from the STOWED state (4106), when a second of the primary and the secondary modules which is mechanically coupled immediately, serially lower to the one of the primary and the secondary modules does not have the vehicle (100) present and the state of the second of the primary and the secondary modules is either of DEPLOYED state or DEPLOYED_CLEAR state, the state of the one of the primary and the secondary modules autonomously transitions to the STOWED_CLEAR state (4108);
from the state (4108), the SUCCESS condition always includes a command-directed transition to the READY_TO_DEPLOY state (4120);
from the READY_TO_DEPLOY state (4120), the SUCCESS condition always includes a command-directed transition back to the STOWED_CLEAR state (4108), and, from the READY_TO_DEPLOY state (4120), when a SUCCESS condition that includes receipt of the ACK signal and the commanded status of the one of the primary and the secondary modules is the DEPLOYED state, the one of the primary and the secondary modules command-directed transitions to the DEPLOYED state (4122);
from the DEPLOYED state (4122), when the vehicle (100) is not present, and the second of the secondary modules which is mechanically coupled immediately, serially higher to the one of the primary and the secondary modules is in either of the STOWED state (4106) or the STOWED_CLEAR state (4108), the one of the primary and the secondary modules autonomously transitions to the DEPLOYED_CLEAR state (4124);
from the DEPLOYED_CLEAR state (4124), the SUCCESS condition always includes a command-directed transition back to the STOWED state (4106), and, from the DEPLOYED_CLEAR state (4124), when a SUCCESS condition that includes receipt of the ACK signal and the command-directed state of the one of the primary and the secondary modules is the STOWED state (4106), the one of the primary and the secondary modules command-directed transitions to the READY_TO_STOW state (4126); and
from the READY_TO_STOW state (4126), the SUCCESS condition always includes a command-directed transition back to the DEPLOYED_CLEAR state (4124), and, from the READY_TO_STOW state (4126), when the SUCCESS condition includes receipt of the ACK signal and the command-directed state of the one of the primary and the secondary modules is the STOWED state (4106), the one of the primary and the secondary modules command-directed transitions back to the STOWED state (4106).
1 Assignment
0 Petitions
Accused Products
Abstract
A system control apparatus and method for systematic control of (i) extraction of a vehicle from an environment, (ii) stowage of the vehicle in a modular handling and stowage system, the system having a primary module and zero or more secondary modules, wherein the secondary modules are serially, mechanically coupled to the primary module and together, and (iii) deployment of the vehicle from the module group in response to command signals, sensor signals, and status signals.
20 Citations
22 Claims
-
1. A system control apparatus (2000) for systematic control of (i) extraction of a vehicle (100) from an environment, (ii) stowage of the vehicle in a modular handling and stowage system (1000), the system having a primary module (1102) and zero or more secondary modules (1104a-1104n), wherein the secondary modules are serially, mechanically coupled to the primary module and together, and (iii) deployment of the vehicle from the module group in response to command signals, sensor signals, and status signals, the system control apparatus comprising:
-
an operator control unit OCU (2012) operated by a User, wherein the OCU generates the command signals as directed by the User, and receives the sensor signals and the status signals; a modules supervisory controller (2110), a primary individual motor controller (2112_PM), and a primary module sensor suite (1250_PM), wherein, the modules supervisory controller (2110), the primary individual motor controller, and the primary module sensor suite are included in the primary module, wherein, the primary individual motor controller (2112_PM) is electrically coupled to the modules supervisory controller, and the modules supervisory controller and the primary module sensor suite are electrically coupled to the OCU, and the modules supervisory controller (2110) receives the command signals, the sensor signals and the status signals, the primary individual motor controller (2112_PM) generates one or more of the status signals and receives the command signals, and the primary module sensor suite generates and presents one or more of the sensor signals; and a secondary individual motor controller (2112a-2112-n) and a secondary module sensor suite (1250a-1250n) that are included in each of the zero or more secondary modules, wherein each of the zero or more secondary modules are electrically coupled to the primary individual motor controller (2112_PM), the secondary individual motor controller (2112a-2112-n) generates one or more of the status signals and receives the command signals, and the secondary module sensor suite generates and presents one or more of the sensor signals;
wherein,the modules supervisory controller (2110) having a microcontroller that includes state control programming configured as a state machine (4000) to control operation of the primary and the secondary module controllers and the primary and the secondary sensor suites with respect to transition between states, the states including; UNKNOWN (4102);
UNKNOWN_CLEAR_TO_STOW (4104);
STOWED (4106);
STOWED_CLEAR (4108);
SOLENOID_ACTIVE (4110);
READY_TO_DEPLOY (4120);
DEPLOYED (4122);
DEPLOYED_CLEAR (4124); and
READY_TO_STOW (4126);wherein, an acknowledgment status signal (ACK) indicates proper receipt of one of the command signals, a non-acknowledgment status signal (NAK) indicates failure to receive one of the command signals, and a SUCCESS condition for the state machine (4000) is defined as receipt of the status signal ACK; wherein the transition between the states comprises; starting with one of the primary and the secondary modules at the UNKNOWN state (4102), when the vehicle (100) is not present and the one of the primary and the secondary modules is at either of the STOWED and STOWED_CLEAR states, the state of the one of the primary and the secondary modules autonomously transitions to the UNKNOWN_CLEAR_TO_STOW state (4104); from the UNKNOWN_CLEAR_TO_STOW state (4104), when the one of the primary and the secondary modules achieves a SUCCESS condition that is defined as receipt of the signal ACK and includes one of the primary and the secondary modules the vehicle (100) in the stowed position, the state of the one of the primary and the secondary modules command-directed transitions to the STOWED state (4106); from the STOWED state (4106), when a second of the primary and the secondary modules which is mechanically coupled immediately, serially lower to the one of the primary and the secondary modules does not have the vehicle (100) present and the state of the second of the primary and the secondary modules is either of DEPLOYED state or DEPLOYED_CLEAR state, the state of the one of the primary and the secondary modules autonomously transitions to the STOWED_CLEAR state (4108); from the state (4108), the SUCCESS condition always includes a command-directed transition to the READY_TO_DEPLOY state (4120); from the READY_TO_DEPLOY state (4120), the SUCCESS condition always includes a command-directed transition back to the STOWED_CLEAR state (4108), and, from the READY_TO_DEPLOY state (4120), when a SUCCESS condition that includes receipt of the ACK signal and the commanded status of the one of the primary and the secondary modules is the DEPLOYED state, the one of the primary and the secondary modules command-directed transitions to the DEPLOYED state (4122); from the DEPLOYED state (4122), when the vehicle (100) is not present, and the second of the secondary modules which is mechanically coupled immediately, serially higher to the one of the primary and the secondary modules is in either of the STOWED state (4106) or the STOWED_CLEAR state (4108), the one of the primary and the secondary modules autonomously transitions to the DEPLOYED_CLEAR state (4124); from the DEPLOYED_CLEAR state (4124), the SUCCESS condition always includes a command-directed transition back to the STOWED state (4106), and, from the DEPLOYED_CLEAR state (4124), when a SUCCESS condition that includes receipt of the ACK signal and the command-directed state of the one of the primary and the secondary modules is the STOWED state (4106), the one of the primary and the secondary modules command-directed transitions to the READY_TO_STOW state (4126); and from the READY_TO_STOW state (4126), the SUCCESS condition always includes a command-directed transition back to the DEPLOYED_CLEAR state (4124), and, from the READY_TO_STOW state (4126), when the SUCCESS condition includes receipt of the ACK signal and the command-directed state of the one of the primary and the secondary modules is the STOWED state (4106), the one of the primary and the secondary modules command-directed transitions back to the STOWED state (4106). - View Dependent Claims (2)
-
-
3. A system control apparatus (2000) for systematic control of extraction of a vehicle (100) from an environment,
stowage of the vehicle in a modular handling and stowage system (1000) having a primary module (1102) and zero or more secondary modules (1104a-1104n) that are serially, mechanically coupled together, and deployment of the vehicle from the module group in response to command signals, sensor signals, and status signals, the system control apparatus comprising: -
an operator control unit OCU (2012) operated by a User, wherein the OCU generates the command signals as directed by the User, and receives the sensor signals and the status signals; a modules supervisory controller (2110), a primary individual motor controller (2112_PM), and a primary module sensor suite (1250_PM), wherein, the modules supervisory controller (2110), the primary individual motor controller, and the primary module sensor suite are included in the primary module, wherein, the primary individual motor controller (2112_PM) is electrically coupled to the modules supervisory controller, and the modules supervisory controller and the primary module sensor suite are electrically coupled to the OCU, and the modules supervisory controller (2110) receives the command signals, the sensor signals and the status signals, the primary individual motor controller (2112_PM) generates one or more of the status signals and receives the command signals, and the primary module sensor suite generates and presents one or more of the sensor signals; and a secondary individual motor controller (2112a-2112-n) and a secondary module sensor suite (1250a-1250n) that are included in each of the zero or more secondary modules, wherein each of the zero or more secondary modules are electrically coupled to the primary individual motor controller (2112_PM), the secondary individual motor controller generates one or more of the status signals and receives the command signals, and the secondary module sensor suite generates and presents one or more of the sensor signals;
wherein,the modules supervisory controller (2110) having a microcontroller that comprises a state machine (4000) that further comprises timing control programming (5000) configured to control operation of the primary and the secondary module controllers and the primary and the secondary sensor suites, wherein, the modules supervisory controller (2110) further comprises (i) a main process (2520), and (ii) a component manager process (2522);
wherein, the operation of the primary and the secondary module controllers and the primary and the secondary sensor suites comprises the steps;(5010) starting the component manager process (2522), wherein, the component manager process (2522) manages the command signals, the sensor signals, and the status signals for the modules supervisory controller (2110); and
after the component manager process (2522) is running, starting the main process (2520), and connecting the main process (2520) to the component manager process (2522), thereby providing capability for the main process (2520) to send and receive the command signals, the sensor signals, and the status signals;(5012) after the main process (2520) is started, (5020) creating a module manager (2526), wherein, the module manager (2526), (5024) detects attachment and/or detachment of the primary and/or secondary individual motor controllers (2112), and (5026) generates one or more of the status signals that indicate when attachment and/or detachment of the primary and/or secondary individual motor controllers has occurred; (5030) creating the component manager process (2522) for each of the primary and/or secondary individual motor controllers (2112), wherein, the component manager process (2522) manages all of the signal management components (2532), and the module manager (2526) and the component manager process (2522) manage the command signals; after creation of the module manager (2526) and the component manager process (2522), (5032) registering the component manager process (2522) to the module manager (2526) to enable reception of the status signals that indicate attachment and/or detachment of the primary and/or secondary individual motor controllers (2112); (5034) creating a signal management component (2532) for each of the secondary module (1104) that is attached, and deleting the signal management component (2532) as each of the secondary modules (1104) is detached, wherein, the signal management component (2532) presents the status signals to and receives the status signals from the primary and/or secondary individual motor controllers (2112), and maintains a state for the primary and/or secondary individual motor controllers (2112); (5042) after a predetermined period of time has elapsed, locking in a base configuration of the primary module (1102) and the zero or more secondary modules (1104), and (5044) registering services within the component manager process (2522), wherein, the base configuration comprises which of the secondary modules (1104) are present and are adjacent to one another; activating the component manager process (2522); and starting a periodic main loop (5100), wherein the main loop (5100) continues until the component manager process (2522) is stopped. - View Dependent Claims (4, 5, 6)
-
-
7. A system control apparatus (2000) for systematic control of (i) extraction of a vehicle (100) from an environment, (ii) stowage of the vehicle in a modular handling and stowage system (1000), the system having a primary module (1102) and zero or more secondary modules (1104a-1104n), wherein the secondary modules are serially, mechanically coupled to the primary module and together, and (iii) deployment of the vehicle from the module group in response to command signals, sensor signals, and status signals, the system control apparatus comprising:
-
an operator control unit OCU (2012) operated by a User, wherein the OCU generates the command signals as directed by the User, and receives the sensor signals and the status signals; a modules supervisory controller (2110), a primary individual motor controller) (2112_PM, and a primary module sensor suite (1250_PM), wherein, the modules supervisory controller (2110), the primary individual motor controller, and the primary module sensor suite are included in the primary module, wherein, the primary individual motor controller (2112_PM) is electrically coupled to the modules supervisory controller, and the modules supervisory controller and the primary module sensor suite are electrically coupled to the OCU, and the modules supervisory controller (2110) receives the command signals, the sensor signals and the status signals, the primary individual motor controller (2112_PM) generates one or more of the status signals and receives the command signals, and controls one or more primary actuators, and the primary module sensor suite generates and presents one or more of the sensor signals; and a secondary individual motor controller (2112a-2112-n) and a secondary module sensor suite (1250a-1250n) that are included in each of the zero or more secondary modules, wherein each of the zero or more secondary modules are electrically coupled to the primary individual motor controller (2112_PM), the secondary individual motor controller (2112a-2112-n) generates one or more of the status signals and receives the command signals, and each of the secondary individual motor controllers controls a secondary actuator, and the secondary module sensor suite generates and presents one or more of the sensor signals;
wherein,the modules supervisory controller (2110) having a microcontroller that includes status control programming configured as a state machine (4000) to control operation of the primary and the secondary module controllers and the primary and the secondary sensor suites with respect to transition between statuses, the statuses including; POWER_OFF (4020);
ERROR (4052);
UNKNOWN (4102);
UNKNOWN_CLEAR_TO_STOW (4104);
STOWED (4106);
STOWED_CLEAR (4108);
SOLENOID_ACTIVE (4110);
READY_TO_DEPLOY (4120);
DEPLOYED (4122);
DEPLOYED_CLEAR (4124);
READY_TO_STOW (4126);
INITIALIZATION (4200);
MAIN LOOP (4300);
STOWING (4310);
DEPLOYING (4350);
RECEIVE_VEHICLE (4360);wherein, the transition between the statuses comprises; when the state machine (4000) is at the POWER_OFF status (4020) and power is applied, the state machine (4000) is activated and the INITIALIZATION status (4200) begins; when, conversely, the state machine (4000) is in an active condition and power is removed, the state machine (4000) autonomously transitions to the POWER_OFF status (4020); and at the INITIALIZATION status (4200), the state machine (4000), in response to the sensor signals, determines the status of all of the primary and/or zero or more secondary modules, when the primary and/or zero or more secondary module is at the UNKNOWN status (4102), the state machine autonomously transitions to the MAIN_LOOP status (4300), and command-directed transitions to the STOWED status (4106) in response to a stow command, or to the DEPLOYED status(4122) in response to a deploy command signal. - View Dependent Claims (8, 9, 10, 11)
-
-
12. A method for systematic control of (i) extraction of a vehicle (100) from an environment, (ii) stowage of the vehicle in a modular handling and stowage system (1000), the system having a primary module (1102) and zero or more secondary modules (1104a-1104n), wherein the secondary modules are serially, mechanically coupled to the primary module and together, and (iii) deployment of the vehicle from the module group in response to command signals, sensor signals, and status signals, wherein, the system comprises a system control apparatus (2000), the system control apparatus comprising:
-
an operator control unit OCU (2012) operated by a User, wherein the OCU generates the command signals as directed by the User, and receives the sensor signals and the status signals; a modules supervisory controller (2110), a primary individual motor controller (2112_PM), and a primary module sensor suite (1250_PM), wherein, the modules supervisory controller (2110), the primary individual motor controller, and the primary module sensor suite are included in the primary module, wherein, the primary individual motor controller (2112_PM) is electrically coupled to the modules supervisory controller, and the modules supervisory controller and the primary module sensor suite are electrically coupled to the OCU, and the modules supervisory controller (2110) receives the command signals, the sensor signals and the status signals, the primary individual motor controller (2112_PM) generates one or more of the status signals and receives the command signals, and the primary module sensor suite generates and presents one or more of the sensor signals; and a secondary individual motor controller (2112a-2112-n) and a secondary module sensor suite (1250a-1250n) that are included in each of the zero or more secondary modules, wherein each of the zero or more secondary modules are electrically coupled to the primary individual motor controller (2112_PM), the secondary individual motor controller (2112a-2112-n) generates one or more of the status signals and receives the command signals, and the secondary module sensor suite generates and presents one or more of the sensor signals;
wherein,the modules supervisory controller (2110) having a microcontroller that includes state control programming configured as a state machine (4000) to control operation of the primary and the secondary module controllers and the primary and the secondary sensor suites with respect to transition between states, the states including; UNKNOWN (4102);
UNKNOWN_CLEAR_TO_STOW (4104);
STOWED (4106);
STOWED_CLEAR (4108);
SOLENOID_ACTIVE (4110);
READY_TO_(4120);
DEPLOYED (4122);
DEPLOYED_CLEAR (4124); and
READY_TO_STOW (4126);wherein, an acknowledgment status signal (ACK) indicates proper receipt of one of the command signals, a non-acknowledgment status signal (NAK) indicates failure to receive one of the command signals, and a SUCCESS condition for the state machine (4000) is defined as receipt of the status signal ACK; wherein, the method comprises; starting with one of the primary and the secondary modules at the UNKNOWN state (4102), when the vehicle (100) is not present and the one of the primary and the secondary modules is at either of the STOWED and STOWED_CLEAR states, the state of the one of the primary and the secondary modules autonomously transitioning to the UNKNOWN_CLEAR_TO_STOW state (4104); from the UNKNOWN_CLEAR_TO_STOW state (4104), when the one of the primary and the secondary modules achieves a SUCCESS condition that is defined as receiving the signal ACK and includes having one of the primary and the secondary modules the vehicle (100) in the stowed position, the state of the one of the primary and the secondary modules command-directed transitioning to the STOWED state (4106); from the STOWED state (4106), when a second of the primary and the secondary modules which is mechanically coupled immediately, serially lower to the one of the primary and the secondary modules not having the vehicle (100) present and the state of the second of the primary and the secondary modules is either of DEPLOYED state or DEPLOYED_CLEAR state, the state of the one of the primary and the secondary modules autonomously transitioning to the STOWED_CLEAR state (4108); from the state (4108), the SUCCESS condition always including command-directed transitioning to the READY_TO_DEPLOY state (4120); from the READY_TO_DEPLOY state (4120), the SUCCESS condition always including command-directed transitioning back to the STOWED_CLEAR state (4108), and, from the READY_TO_DEPLOY state (4120), when a SUCCESS condition that includes receiving the ACK signal and the commanded status of the one of the primary and the secondary modules is the DEPLOYED state, the one of the primary and the secondary modules command-directed transitioning to the DEPLOYED state (4122); from the DEPLOYED state (4122), when the vehicle (100) is not present, and the second of the secondary modules which is mechanically coupled immediately, serially higher to the one of the primary and the secondary modules is in either of the STOWED state (4106) or the STOWED_CLEAR state (4108), the one of the primary and the secondary modules autonomously transitioning to the DEPLOYED_CLEAR state (4124); from the DEPLOYED_CLEAR state (4124), the SUCCESS condition always including command-directed transitioning back to the STOWED state (4106), and, from the DEPLOYED_CLEAR state (4124), when a SUCCESS condition that includes receiving the ACK signal and the command-directed state of the one of the primary and the secondary modules is the STOWED state (4106), the one of the primary and the secondary modules command-directed transitioning to the READY_TO_STOW state (4126); and from the READY_TO_STOW state (4126), the SUCCESS condition always including command-directed transitioning back to the DEPLOYED_CLEAR state (4124), and, from the READY_TO_STOW state (4126), when the SUCCESS condition includes receiving the ACK signal and the command-directed state of the one of the primary and the secondary modules is the STOWED state (4106), the one of the primary and the secondary modules command-directed transitioning back to the STOWED state (4106). - View Dependent Claims (13)
-
-
14. A method for systematic control of extraction of a vehicle (100) from an environment, stowage of the vehicle in a modular handling and stowage system (1000) having a primary module (1102) and zero or more secondary modules (1104a-1104n) that are serially, mechanically coupled together, and deployment of the vehicle from the module group in response to command signals, sensor signals, and status signals, wherein the system comprises a system control apparatus (2000), the system control apparatus comprises:
-
an operator control unit OCU (2012) operated by a User, wherein the OCU generates the command signals as directed by the User, and receives the sensor signals and the status signals; a modules supervisory controller (2110), a primary individual motor controller (2112_PM), and a primary module sensor suite (1250_PM), wherein, the modules supervisory controller (2110), the primary individual motor controller, and the primary module sensor suite are included in the primary module, wherein, the primary individual motor controller (2112_PM) is electrically coupled to the modules supervisory controller, and the modules supervisory controller and the primary module sensor suite are electrically coupled to the OCU, and the modules supervisory controller (2110) receives the command signals, the sensor signals and the status signals, the primary individual motor controller (2112_PM) generates one or more of the status signals and receives the command signals, and the primary module sensor suite generates and presents one or more of the sensor signals; and a secondary individual motor controller (2112a-2112-n) and a secondary module sensor suite (1250a-1250n) that are included in each of the zero or more secondary modules, wherein each of the zero or more secondary modules are electrically coupled to the primary individual motor controller (2112_PM), the secondary individual motor controller generates one or more of the status signals and receives the command signals, and the secondary module sensor suite generates and presents one or more of the sensor signals;
wherein,the modules supervisory controller (2110) having a microcontroller that comprises a state machine (4000) that further comprises timing control programming (5000) configured to control operation of the primary and the secondary module controllers and the primary and the secondary sensor suites, wherein, the modules supervisory controller (2110) further comprises (i) a main process (2520), and (ii) a component manager process (2522);
wherein,the method comprising the steps; (5010) starting the component manager process (2522), wherein, the component manager process (2522) manages the command signals, the sensor signals, and the status signals for the modules supervisory controller (2110); and
after the component manager process (2522) is running, starting the main process (2520), and connecting the main process (2520) to the component manager process (2522), thereby providing capability for the main process (2520) to send and receive the command signals, the sensor signals, and the status signals;(5012) after the main process (2520) is started, (5020) creating a module manager (2526), wherein, the module manager (2526), (5024) detects attachment and/or detachment of the primary and/or secondary individual motor controllers (2112), and (5026) generates one or more of the status signals that indicate when attachment and/or detachment of the primary and/or secondary individual motor controllers has occurred; (5030) creating the component manager process (2522) for each of the primary and/or secondary individual motor controllers (2112), wherein, the component manager process (2522) manages all of the signal management components (2532), and the module manager (2526) and the component manager process (2522) manage the command signals; after creation of the module manager (2526) and the component manager process (2522), (5032) registering the component manager process (2522) to the module manager (2526) to enable reception of the status signals that indicate attachment and/or detachment of the primary and/or secondary individual motor controllers (2112); (5034) creating a signal management component (2532) for each of the secondary module (1104) that is attached, and deleting the signal management component (2532) as each of the secondary modules (1104) is detached, wherein, the signal management component (2532) presents the status signals to and receives the status signals from the primary and/or secondary individual motor controllers (2112), and maintains a state for the primary and/or secondary individual motor controllers (2112); (5042) after a predetermined period of time has elapsed, locking in a base configuration of the primary module (1102) and the zero or more secondary modules (1104), and (5044) registering services within the component manager process (2522), wherein, the base configuration comprises which of the secondary modules (1104) are present and are adjacent to one another; activating the component manager process (2522); and starting a periodic main loop (5100), wherein the main loop (5100) continues until the component manager process (2522) is stopped. - View Dependent Claims (15, 16, 17)
-
-
18. A method for systematic control of (i) extraction of a vehicle (100) from an environment, (ii) stowage of the vehicle in a modular handling and stowage system (1000), the system having a primary module (1102) and zero or more secondary modules (1104a-1104n), wherein the secondary modules are serially, mechanically coupled to the primary module and together, and (iii) deployment of the vehicle from the module group in response to command signals, sensor signals, and status signals, wherein the system comprises a system control apparatus (2000), the system control apparatus comprising:
-
an operator control unit OCU (2012) operated by a User, wherein the OCU generates the command signals as directed by the User, and receives the sensor signals and the status signals; a modules supervisory controller (2110), a primary individual motor controller (2112_PM), and a primary module sensor suite (1250_PM), wherein, the modules supervisory controller (2110), the primary individual motor controller, and the primary module sensor suite are included in the primary module, wherein, the primary individual motor controller (2112_PM) is electrically coupled to the modules supervisory controller, and the modules supervisory controller and the primary module sensor suite are electrically coupled to the OCU, and the modules supervisory controller (2110) receives the command signals, the sensor signals and the status signals, the primary individual motor controller (2112_PM) generates one or more of the status signals and receives the command signals, and controls one or more primary actuators, and the primary module sensor suite generates and presents one or more of the sensor signals; and a secondary individual motor controller (2112a-2112-n) and a secondary module sensor suite (1250a-1250n) that are included in each of the zero or more secondary modules, wherein each of the zero or more secondary modules are electrically coupled to the primary individual motor controller (2112_PM), the secondary individual motor controller (2112a-2112-n) generates one or more of the status signals and receives the command signals, and each of the secondary individual motor controllers controls a secondary actuator, and the secondary module sensor suite generates and presents one or more of the sensor signals;
wherein,the modules supervisory controller (2110) having a microcontroller that includes status control programming configured as a state machine (4000) to control operation of the primary and the secondary module controllers and the primary and the secondary sensor suites with respect to transition between statuses, the statuses including; POWER_OFF (4020);
ERROR (4052);
UNKNOWN (4102);
UNKNOWN_CLEAR_TO_STOW (4104);
STOWED (4106);
STOWED_CLEAR (4108);
SOLENOID_ACTIVE (4110);
READY_TO_DEPLOY (4120);
DEPLOYED (4122);
DEPLOYED_CLEAR (4124);
READY_TO_STOW (4126);
INITIALIZATION (4200);
MAIN LOOP (4300);
STOWING (4310);
DEPLOYING (4350);
RECEIVE_VEHICLE (4360);wherein, the method comprising; when the state machine (4000) is at the POWER_OFF status (4020) and power is applied, actuating the state machine (4000) and beginning the INITIALIZATION status (4200); when, conversely, the state machine (4000) is in an active condition and power is removed, the state machine (4000) autonomously transitioning to the POWER_OFF status (4020); and at the INITIALIZATION status (4200), the state machine (4000), in response to the sensor signals, determines the status of all of the primary and/or zero or more secondary modules, when the primary and/or zero or more secondary module is at the UNKNOWN status (4102), the state machine autonomously transitioning to the MAIN_LOOP status (4300), and command-directed transitioning to the STOWED status (4106) in response to a stow command, or to the DEPLOYED status(4122) in response to a deploy command signal. - View Dependent Claims (19, 20, 21, 22)
-
Specification