SYSTEMS AND METHODS FOR RAIL WORKER AND RAIL VEHICLE WARNING AND POSITION DETERMINATION
20210309268 · 2021-10-07
Inventors
- Douglas Grant Fisher (Edmonton, CA)
- Robert Donovan (Edmonton, CA)
- Craig Ryan van der Veen (Edmonton, CA)
- Carl William Lorimer (Edmonton, CA)
Cpc classification
B61L23/06
PERFORMING OPERATIONS; TRANSPORTING
B61L23/34
PERFORMING OPERATIONS; TRANSPORTING
B61L25/025
PERFORMING OPERATIONS; TRANSPORTING
B61L3/12
PERFORMING OPERATIONS; TRANSPORTING
B61L15/0072
PERFORMING OPERATIONS; TRANSPORTING
B61L2205/04
PERFORMING OPERATIONS; TRANSPORTING
International classification
B61L23/06
PERFORMING OPERATIONS; TRANSPORTING
B61L15/00
PERFORMING OPERATIONS; TRANSPORTING
B61L23/34
PERFORMING OPERATIONS; TRANSPORTING
B61L3/00
PERFORMING OPERATIONS; TRANSPORTING
B61L3/12
PERFORMING OPERATIONS; TRANSPORTING
Abstract
System and methods are provided for warning a worker of a rail vehicle, or an operator of the rail vehicle of the worker. The system includes a worker device, a vehicle device, and a central server. The devices and server operate on one or a combination of actual or simulated satellite navigational signals, and beacon signals to determine the position of the devices, to generate a warning. The position determination may prioritize beacon signals over satellite navigation signals. The position determination may involve correcting a calculated position based on a measured power level of the beacon signal received from the beacon transmitter, an elapsed time since a previous beacon signal was last received by the device from the beacon transmitter, an elapsed time since a previous satellite navigation signal was received by the device, or an accuracy of the position of the device based on the satellite navigation signal.
Claims
1. A system for warning a worker of a rail vehicle, or an operator of the rail vehicle of the worker, the system comprising: (a) a satellite navigation signal simulator for radiating satellite navigation signals; (b) a worker device adapted for carrying by the worker, wherein the worker device comprises: a first receiver for receiving satellite navigation signals; a first transceiver for transceiving data via a communications network; a first output device comprising one or a combination of a first display device, a first speaker, and a first vibrator; a first processor operatively connected to the first receiver, the first transceiver, the first output device, and a first non-transitory computer readable medium storing instructions readable by the first processor to implement a first method comprising the steps of: (i) determining one or a combination of position, speed, or direction (kinematic data) of the worker device based at least on satellite navigation signals received by the first receiver; (ii) causing the first transceiver to transmit the determined kinematic data of the worker device via the communications network; and (iii) causing the first output device to generate a visual, audible, or haptic warning in response to notification data received by the first transceiver via the communications network; (c) a vehicle device adapted to be placed onboard the rail vehicle, wherein the vehicle device comprises: a second receiver for receiving satellite navigation signals; a second transceiver for transceiving data via the communications network; a second output device comprising one or a combination of a second display device, a second speaker, and a second vibrator; a second processor operatively connected to the second receiver, the second transceiver, the second output device, and a second non-transitory computer readable medium storing instructions readable by the second processor to implement a second method comprising the steps of: (i) determining one or a combination of position, speed, or direction (kinematic data) of the vehicle device based at least on satellite navigation signals received by the second receiver; (ii) causing the second transceiver to transmit the determined kinematic data of the vehicle device via the communications network; and (iii) causing the output device to generate a visual, audible, or haptic warning in response to notification data received by the second transceiver via the communications network; and (d) a central server comprising: a third transceiver for transceiving data via the communications network; and a third processor operatively connected to the transceiver, and a third non-transitory computer readable medium storing instructions readable by the third processor to implement a third method comprising the steps of: (i) determining if a safety rule is violated based at least on one or a combination of the kinematic data of the worker device, and the kinematic data of the vehicle device received by the third transceiver; and (ii) if the safety rule is violated, causing the third transceiver to transmit notification data to one or a combination of the worker device, and the vehicle device via the communications network.
2. A system for warning a worker of a rail vehicle, or an operator of the rail vehicle of the worker, the system comprising: (a) a plurality of beacon transmitters for radiating beacon signals along the railway; (b) a worker device adapted for carrying by the worker, wherein the worker device comprises: a first receiver for receiving beacon signals; a first transceiver for transceiving data via a communications network; a first output device comprising one or a combination of a first display device, a first speaker, and a first vibrator; a first processor operatively connected to the first receiver, the first transceiver, the output device, and a non-transitory computer readable medium storing instructions readable by the first processor to implement a first method comprising the steps of: (i) determining a received signal strength of beacon signals received by the first receiver; (ii) causing the first transceiver to transmit the determined received signal strength of beacon signals received by the first receiver via the communications network; and (iii) causing the output device to generate a visual, audible, or haptic warning in response to notification data received by the first transceiver via the communications network; (c) a vehicle device adapted to be placed onboard the rail vehicle, wherein the vehicle device comprises: a second receiver for receiving beacon signals; a second transceiver for transceiving data via the communications network; a second output device comprising one or a combination of a second display device, a second speaker, and a second vibrator; a second processor operatively connected to the second receiver, the second transceiver, the second output device, and a second non-transitory computer readable medium storing instructions readable by the second processor to implement a second method comprising the steps of: (i) determining a received signal strength of beacon signals received by the second receiver; (ii) causing the second transceiver to transmit the determined strength of beacon signals received by the second receiver via the communications network; and (iii) causing the second output device to generate a visual, audible, or haptic warning in response to notification data received by the second transceiver via the communications network; (d) a central server comprising: a transceiver for transceiving data via the communications network; and a processor operatively connected to the transceiver, and a non-transitory computer readable medium storing instructions readable by the processor to implement a third method comprising the steps of: (i) determining one or a combination of position, speed, or direction (kinematic data) of the worker device based at least on the received signal strength of beacon signals received by the first receiver, as received by the third transceiver via the communications network; (ii) determining one or a combination of position, speed, or direction (kinematic data) of the vehicle device based at least on the received signal strength of beacon signals received by the second receiver, as received by the third transceiver via the communications network; (iii) determining if a safety rule is violated based at least on one or a combination of the kinematic data of the worker device, and the kinematic data of the vehicle device received by the transceiver; and (iv) if the safety rule is violated, causing the transceiver to transmit notification data to one or a combination of the worker device, and the vehicle device via the communications network.
3. A method for warning a worker of a rail vehicle, or for warning an operator of the rail vehicle of the worker, the method implemented by a device carried by the worker, or placed onboard the rail vehicle, the device comprising: a first receiver for receiving beacon signals; a second receiver for receiving satellite navigation signals; a transceiver for transceiving data via a communications network; an output device comprising one or a combination of a display device, a speaker, and a vibrator; and a processor operatively connected to the first receiver, the second receiver, the transceiver, the output device, and a non-transitory computer readable medium storing instructions readable by the processor to implement the method, the method comprising the steps of: (a) determining if beacon signals are received by the first receiver, and if so, then: (i) determining a received signal strength of beacon signals received by the first receiver; and (ii) causing the transceiver to transmit the determined strength of beacon signals received by the first receiver via the communications network; and (b) if it is determined that beacon signals are not received by the first receiver, then determining if satellite navigation signals are received by the second receiver, and if so, then: (i) determining one or a combination of position, speed, or direction (kinematic data) of the device based at least on satellite navigation signals received by the second receiver; and (ii) causing the transceiver to transmit the determined kinematic data of the device via the communications network; and (c) causing the output device to generate a visual, audible, or haptic warning in response to notification data received by the transceiver via the communications network, wherein the notification data is based at least on either the transmitted determined strength of beacon signals received by the first receiver, or the transmitted determined kinematic data of the device.
Description
BRIEF DESCRIPTION OF THE DRAWINGS
[0067] In the drawings, like elements may be assigned like reference numerals. The drawings are not necessarily to scale, with the emphasis instead placed upon the principles of the present invention. Additionally, each of the embodiments depicted are but one of a number of possible arrangements utilizing the fundamental concepts of the present invention.
[0068]
[0069]
[0070]
[0071]
[0072]
[0073]
[0074]
[0075]
[0076]
[0077]
[0078]
[0079]
[0080]
DETAILED DESCRIPTION OF EMBODIMENTS OF THE INVENTION
Definitions
[0081] The invention relates to systems, methods, and computer program products for warning a worker of a rail vehicle, or an operator of the rail vehicle of the worker, which may be used to reduce the risk of a collision between the worker and the rail vehicle. The invention also relates to systems, methods, and computer program products for determining the position of a vehicle device onboard the rail vehicle and of a worker device carried by the worker.
[0082] Any term or expression not expressly defined herein shall have its commonly accepted definition understood by a person skilled in the art. As used herein, the following terms have the following meanings.
[0083] “Beacon transmitter” refers to a Earth-based electronic device that transmits a radio frequency signal (a beacon signal), which allows the position of a receiving device to be determined based on one or a combination of data encoded in the beacon signal, and a power or strength of the received beacon signal. Non-limiting examples of a beacon transmitter include a Bluetooth beacon transmitter, or an ultra-wide band (UWB) transmitter.
[0084] “Leaky feeder” (also known as a “leaky coaxial cable”, “leaky coax” or “radiating cable”) refers to a coaxial cable that is capable of radiating a radio frequency signal at a gap, slot, or other discontinuity in its insulating layer surrounding its conductive core, which insulating layer would otherwise prevent or limit radiation of the radio frequency signal.
[0085] “Memory” refers to a non-transitory tangible medium for storing information in a format readable by a processor, and/or instructions readable by a processor to implement an algorithm. Non-limiting types of memory include solid-state, optical, and magnetic based computer readable media.
[0086] “Processor” refers to one or more electronic devices that are capable of reading and executing instructions stored on a memory to perform operations on data, which may be stored on a memory or provided in a data signal. Non-limiting examples of processors include devices referred to as microprocessors, microcontrollers, central processing units (CPU), and digital signal processors.
[0087] “Quantitative relationship” refers to a relationship, which can be used by a processor, to determine a value of a variable based on a value of at least one other variable. Non-limiting forms of quantitative relationships include a mathematical function, a data point set (e.g., in the form of a lookup table or associative array), a best-fit curve applied to a data point set, or a Boolean operator. Irrespective of the form of the quantitative relationship, a quantitative relationship to determine the numeric value of a variable, β, based on numerical values of a set of one or more variables (α.sub.1, α.sub.2, . . . α.sub.n), may be symbolically represented herein by the notation: β=f (α.sub.1, α.sub.2, . . . α.sub.n). The present invention is not limited by the manner in which a quantitative relationship is determined. For example, a quantitative relationship may be based on either one or a combination of a rational model according to theory, and empirical data.
[0088] “Rail vehicle” refers to any machine that moves on a railway, whether the railway is situated above ground or below ground. Non-limiting examples of rail vehicles include trains and trams, such as may be used to transport people or goods, as well as maintenance vehicles.
[0089] “Satellite navigation signal” refers to a radio frequency signal originating from a satellite orbiting the Earth, which allows the position of a receiving device to be determined by processing the signal (e.g., by signal trilateration or other techniques). Non-limiting examples of satellite navigation signal include signals transmitted by the Global Positioning System (GPS), the Global Navigation Satellite System (GLONASS), the European Galileo positioning system, the Chinese Beidou Navigation Satellite System, and other regional satellite navigation systems.
[0090] “Satellite navigation signal receiver module” refers to an electronic device that includes an antenna for receiving satellite navigation signals, and an operatively connected processor that is configured with a set of instructions stored on a memory, to analyze such signals to determine the location of the module, and optionally, other information such as speed, and direction of movement of the module. As a non-limiting example, the module may analyze the signals by signal trilateration or other algorithms to determine the foregoing information. Satellite navigation signal receiver modules are known in the art, and do not, by themselves constitute the present invention. Persons skilled in the art may colloquially refer to a satellite navigation signal receiver module as a “GPS receiver,” or a “GNSS receiver,” depending on the type of satellite navigation signal used by the module.
[0091] “Satellite navigation signal simulator” refers to an Earth-based electronic device that transmits radio frequency signals that emulate satellite navigation signals transmitted by an orbiting satellite.
[0092] “Transceiver” refers to an electronic device comprising both a transmitter and a receiver for data signals.
[0093] “Worker” refers to a human being.
[0094] System.
[0095]
[0096] The worker device (100) is intended to be carried by a worker near a railway. The worker device may be adapted to be portable with the worker. As an example, the worker device (100) may be adapted for attachment to a wearable garment or item, with non-limiting examples including a safety vest, a helmet, an arm band, or a belt. Alternatively, the worker device (100) may have a form factor that allows it to be hand-held or placed in a pocket of a garment. All of the foregoing are examples of the worker device (100) being carried by the worker. In one embodiment, the worker device (100) may be implemented by a smartphone, or a tablet computer device.
[0097] The vehicle device (200) is intended to be placed onboard the rail vehicle. More particularly, the vehicle device (200) may be used by an operator in the cab of a rail vehicle. For example, the vehicle device (200) may be adapted with hardware for attachment to or installation in the cab of the rail, such as by attachment to a control panel of a rail vehicle. In one embodiment, the vehicle device (200) may be implemented by a smartphone, or a tablet computer device.
[0098] The central server (300) may be located remotely from the worker and the rail vehicle. As a non-limiting example, the central server (300) may be used by a human administrator of a rail transit system, and located at a central monitoring station of a rail transit system. Therefore, in one embodiment, the central server (300) may be implemented with a laptop or desktop computer, a smartphone, or a tablet computer device having input and output devices that allow the administrator to interact with the central server (300). In another non-limiting example, the central server (300) may perform its functions, without any interaction with a human user. Therefore, in another embodiment, the central server (300) may be implemented by a combined application, database, and web server that host software, data collections, and web page resources for the access by the worker device (100) and the vehicle device (200). The central server (300) may include multiple physically separate computers networked in a distributed computing system.
[0099] In the embodiments of
[0100] A power source provides electrical power to the other components of the device (100 or 200) or the central server (300). As non-limiting examples: in the case of the worker device (100), the power source may a battery, such as a rechargeable lithium-ion battery; in the case of the vehicle device (200), the power source may be an AC power supply, a USB power port, which may be connected by a charging cable to a power supply of the rail vehicle, or a battery, such as a rechargeable lithium-ion battery; and in the case of the central server (300), the power source may be an AC power supply, or a battery, such as a rechargeable lithium-ion battery.
[0101] A microprocessor (i.e., a processor in the form of one or more integrated circuit(s)) executes instructions stored on an associated memory to enable the worker device (100), the vehicle device (200), or the central server (300) (as the case may be) to implement methods described below. As non-limiting examples: in the case of the worker device (100) and the vehicle device (200), the memory may a solid state memory device; and in the case of the central server (300), the memory may be a solid state memory device, or an optical disc. Although
[0102] In the case of the worker device (100), and the vehicle device (200), a satellite navigation signal receiver module (e.g., GPS receiver and associated antenna) receives satellite navigation signals (e.g., GPS signals), which are processed to determine a position of the worker device (100) or the vehicle device (200), as the case may be. The satellite navigation signal receiver module may be optional in embodiments where the worker device (100), and the vehicle device (200) exclusively use beacon signals for location determination.
[0103] Data transceivers permit the worker device (100), the vehicle device (200) or the central server (300) as the case may be to communicate data via a communications network. The transceivers may include one or more transceivers (and associated antenna) for transmitting and receiving radio-frequency signals in accordance with one or a combination of protocols and standards known to persons skilled in the art. As non-limiting examples, the protocol and standards may include Wi-Fi protocols (e.g., as defined by IEEE 802.11 local area network (LAN) protocol), Bluetooth protocols (e.g., as defined by Bluetooth Special Interest Group), cellular standards (e.g., GSM, 3GSM, 4G LTE, 5G NR, as defined by 3GPP, 3.sup.rd Generation Partnership Project), and Terrestrial Trunked Radio (TETRA) standards (as defined by the European Telecommunications Standards Institute (ETSI)). In the case of the vehicle device (200) and the central server (300), the transceivers may also include an Ethernet port, for wired connection to a communications network. In the case of the central server (300), an Ethernet port for wired connection to a communications network may be the preferred data transceiver, in which case the aforementioned transceivers for wireless communication are optional.
[0104] The worker device (100) and the vehicle device (200) have an output device for providing a visual, audible, or haptic feedback to the worker, and the operator of the rail vehicle (respectively). Such output device may in the form of one or a combination of a display screen, an electro-acoustic transducer, and an electro-mechanical vibrator, as described below. Such output device is optional for the central server (300). For example, if the central server (300) is used as a workstation for a human administrator of a rail transit system, then it may be desirable for the central server (300) to include an output device. Alternatively, if the central server (300) is used only to host software, data collections, and web page resources, then such an output device is optional.
[0105] A display screen displays visual information in the form of text, graphics, or a combination thereof. As non-limiting examples, the display device may be a light emitting diode (LED) panel or a liquid crystal display (LCD) panel.
[0106] An electro-acoustic transducer (i.e., a speaker) generates an audible sound.
[0107] An electro-mechanical vibrator (e.g., a vibrating motor) generates vibrations to produce haptic feedback for a user.
[0108] An input device allows a user to provide input into the worker device (100), the vehicle device (200) or the central server (300), as the case may be. As a non-limiting example, the input device may be a button in the form of a mechanical switch. As a non-limiting example, the button may be a “virtual button” of a graphical user interface (GUI) displayed on the display screen, which may be pressed using a touch screen interface, or selected using another user interface device (e.g., a mouse, trackball, keyboard, and the like). An input device is optional for the central server (300). For example, if the central server (300) is used as a workstation for a human administrator of a rail transit system, then it may be desirable for the central server (300) to include an input device. Alternatively, if the central server (300) is used only to host software, data collections, and web page resources, then an input device is optional.
[0109] Method for warning a worker of a rail vehicle.
[0110]
[0111] For simplicity,
[0112] Referring to
[0113] The method begins with the processor of the worker device (100) determining if the data transceiver of the worker device (100) can detect a beacon signal from a beacon transmitter (
[0114] Suppose that the worker device (100) cannot detect a beacon signal (
[0115] In other environments, such as a tunnel (600) as shown in
[0116] As an alternative to the use of a satellite navigation signal simulator (602), the system as shown in
[0117] The data transceiver of the worker device (100) receives beacon signals (
[0118] The processor of the central server (300) processes the beacon signal data, and the beacon signal strength or power data to determine the location of the worker device (100) (
[0119] The transmitted signal strength of the beacon transmitter (700) may be part of the beacon signal data. In this embodiment, the transmitted signal strength may either be an actual transmitted signal strength as measured by a processor associated with the beacon transmitter (700), or a nominal transmitted signal strength that is expected based on specifications of the beacon transmitter (700). Alternatively, the beacon signal data may include an identifier uniquely associated with the beacon transmitter (700), which allows the central server (300) to determine the transmitted signal strength of the beacon transmitter (700) through a relational table stored in a memory of the central server (300). In this embodiment, the transmitted signal strength may be a nominal transmitted signal strength that is expected based on specifications of the beacon transmitter (700). In either case, the central server (300) may use the beacon transmitter position and the determined distance of the worker device (100) from the beacon transmitter (700) to determine a position of the worker device (100). For example, the central server (300) may determine the distance of the worker device (100) from three beacon transmitters associated with the strongest received signal strengths at the worker device (100). The central server (300) may then determine the position of the worker device (100) by signal trilateration, as known to persons skilled in the art.
[0120] It will be apparent that the processor of the central server (300) may further determine the speed and direction of movement of the worker device (100) by determining its position at successive times, either at known time intervals, or at times measured by a computer clock, and using quantitative relationships relating direction of movement to positional change, and relating speed to positional change over time, as are known in the art of kinematics.
[0121] The above description of the determination of the kinematic data for the worker device (100) applies in an analogous manner to the determination of the kinematic data for the vehicle device (200). Hence the steps in
[0122] The method continues with the processor of the central server (300) determining a safety metric based on one or a combination of the worker device (100)'s kinematic data, and the vehicle device (200)'s kinematic data (
[0123] The method continues with the processor of the central server (300) determining if the safety metric violates a predetermined safety rule, which safety rule is stored in the memory of the central server (300) (
[0124] If the central server (300) determines that the safety rule is violated, then the method continues with the processor of the central server (300) causing the data transceiver of the central server (300) sending notification data via a communications network (
[0125] The method continues with the data transceiver of one or a combination of the worker device (100), the vehicle device (200), and another device, receiving the notification data. In response, the processor of the device(s) causes the output device(s) of the device(s) to generate one or a combination of a visual, audible, or haptic warning of the safety rule violation (
[0126] Method for determining position of a worker device or vehicle device based on multiple signals.
[0127] As noted above, determining the position of workers or rail vehicles based on a single signal can result in significant, transient, and unpredictable inaccuracies. To address this problem, the present invention provides a method for determining the position of a worker device (100) or a vehicle device (200) based on multiple signal sources, which may the same or different in type. Such multiple signals may include beacon signals, a satellite navigation signal, or a combination of beacon signals and satellite navigation signals.
[0128]
[0129] In
[0130]
[0131] The method is initiated by the first step of receiving new beacon signals, and/or a satellite navigations signal at a given instance of time (
[0132] The next step (
[0133] The next step (
[0134] In Eqn. 1, the parameter, RSSI.sub.i (received signal strength indication) is a measurement of the power present in the beacon signal as received by the vehicle device (200). The concept of received signal strength indication, and its measurement using device such as wireless networking cards, are known to persons skilled in the art. The parameter K.sub.1,i is a constant indicative of the signal strength of the beacon transmitter at a specified distance from the beacon transmitter. For example, K.sub.1,i may be the power present in the received beacon signal measured at a distance of one meter from the beacon transmitter. The parameter K.sub.2,i is a constant indicative of the decrease of signal strength with distance from the beacon transmitter. For example, the person of ordinary skill in the art may determine the value of the parameter, K.sub.2,i, through a calibration exercise involving the measurement of the RSSI value at a known distance (e.g., 10 meters) from the beacon transmitter. In other embodiments, other quantitative relationships between D.sub.1,I and RSSI, or other measures of beacon signal strength or power, may be used.
[0135]
[0136] The next step (
K.sub.3,i=½(rk.sub.1,i+rk.sub.2,i) (Eqn. 2)
In other embodiments, other quantitative relationships may be used to determine the notional spring constant. For example, the spring constant may be based solely on rk1 or rk2, rather than an average of them as shown in Eqn. 2.
[0137] In Eqn. 2, the parameter rk.sub.1,i accounts for the amount of time elapsed since last “reporting” of the beacon signal. The processor implementing the invention may comprise a computer clock for determining this elapsed time. It will be understood that the present method may be performed on a continuing repeated basis. Therefore, a greater amount of time elapsed since the signal “reported,” tends to indicate that the asset has just moved into range of that beacon signal, and that beacon signal may therefore be considered less relevant to calculating the position of the vehicle device (200), in comparison with a signal that has more recently reported. Therefore, the parameter rk.sub.1 may be determined in accordance with a quantitative relationship that negatively correlates its value to the elapsed time since the beacon transmitter last reported. In one embodiment, rk.sub.1,i is determined in accordance with the following equation, where t.sub.i is the elapsed time since the beacon transmitter last reported.
In other embodiments, other quantitative relationships that negatively correlate the parameters rk.sub.1,i and t.sub.i may be used.
[0138] The parameter rk.sub.2,i accounts for the distance between the beacon transmitter and the vehicle device (200). A greater distance between the beacon transmitter and the vehicle device (200) tends to degrade the beacon signal, and the signal may therefore be considered less relevant to calculating the position of the vehicle device (200), in comparison with a signal from a closer beacon transmitter. The parameter rk.sub.2,i may be determined in accordance with a quantitative relationship that negatively correlates its value to the distance between the beacon transmitter and the vehicle device (200). In one embodiment, rk.sub.2,i is determined in accordance with the following equation.
In Eqn. 4, the parameter, A, is a constant, which may be determined by calibration, and D.sub.1,i is the estimated linear distance as calculated by Eqn. 1. In other embodiments, other quantitative relationships that negatively correlate the parameters rk.sub.2 and D.sub.1,i may be used.
[0139] The next step (
K.sub.SNS=½(rk.sub.1,SNS+rk.sub.2,SNS) (Eqn. 5)
[0140] In other embodiments, other quantitative relationships may be used to determine the notional spring constant. For example, the spring constant may be based solely on rk.sub.1,SNS or rk.sub.2,SNS, rather than an average of them as shown in Eqn. 5.
[0141] In Eqn. 5, the parameter rk.sub.1,SNS accounts for the amount of time elapsed since last “reporting” of the SNS signal. Therefore, the parameter rk.sub.1,SNS may be determined in accordance with a quantitative relationship that negatively correlates its value to the elapsed time since the SNS signal last reported. In one embodiment, rk.sub.1,SNS is determined in accordance with the following equation, where t.sub.SNS is the elapsed time since the SNS signal last reported.
[0142] The parameter rk.sub.2,SNS accounts for the accuracy of the SNS-based position. As the SNS-based position becomes less accurate, it may be considered less relevant. The parameter rk.sub.2,SNS may be determined in accordance with a quantitative relationship that negatively correlates its value to the accuracy of the SNS-based position. In one embodiment, rk.sub.2,SNS is determined in accordance with the following equation.
[0143] In Eqn. 7, the parameter, B, is a constant, which may be determined by calibration. The parameter SNS accuracy is a constant indicative of the SNS-based position accuracy expressed as a distance, with a larger value indicating lower accuracy. For example, for a typical GPS-based position, a value for SNS accuracy may be about 5 meters.
[0144]
[0145] The next step (
F.sub.B,i=K.sub.3,i×(D.sub.2,i−D.sub.1,i)×u.sub.B,i (Eqn. 8)
[0146] In Eqn. 8, the parameter, K.sub.3,i, is a notional spring constant as calculated by Eqns. 2 to 4, above. The parameter D.sub.2,i is the linear distance between position P.sub.B,i and position P.sub.C, as determined geometrically. The parameter D.sub.1,i, is the estimated linear distance between position P.sub.B,i and position P.sub.C, based on the received beacon signal power, as calculated in accordance with Eqn. 1. The parameter u.sub.b,i is the unit vector in the direction from position P.sub.C to position P.sub.B,i. The direction of F.sub.B,i is determined by the sign of scalar value (D.sub.2,i−D.sub.1,i). F.sub.B,i and u.sub.b,I will be in the same direction towards position P.sub.B,I, when position P.sub.c is outside the circle of radius D.sub.1,i centered about position P.sub.B,i. In that case, the notional spring corrects position P.sub.c by “pulling” it towards position P.sub.B,i. Conversely, F.sub.B,i will be in the direction towards position P.sub.c when position P.sub.c is inside the circle of radius D.sub.i,i centered about position P.sub.B,i. In that case, the notional spring corrects position P.sub.c by “pushing” it away from position P.sub.B,i.
[0147] The next step (
F.sub.SNS=K.sub.SNS×D.sub.SNS×u.sub.SNS (Eqn. 9)
In Eqn. 9, the parameter, K.sub.SNS, is a notional spring constant as calculated by Eqns. 5 to 7, above. The parameter D.sub.SNS is the linear distance between position P.sub.SNS and position P.sub.C, as determined geometrically. The parameter u.sub.SNS is the unit vector in the direction from position P.sub.C to position P.sub.SNS. Since the scalar value D.sub.SNS is positive, F.sub.SNS will be in the same direction as u.sub.SNS. Thus notional spring corrects position P.sub.C by “pulling” it towards position P.sub.SNS.
[0148] The next step (
F.sub.R=Σ.sub.i=1.sup.nF.sub.B,i+F.sub.GPS (Eqn. 10)
[0149] The next step (
P.sub.c′=P.sub.c+C×F.sub.R (Eqn. 11)
In Eqn. 11, the parameter, C, is a constant that acts as a scaling factor. Hence the position P.sub.c is corrected by a distance that is proportional to the magnitude of the force F.sub.R. For example, the person skilled in the art may select the value of C by trial-and-error with a view to optimizing computation efficiency and convergence of results over multiple iterations as discussed below.
[0150] The next step (
[0151]
[0152] If it is determined to not perform additional iterations, then the next step (
[0153] The method then returns to step (1000), to await the receipt of new satellite navigation signals and/or beacon signals at a future time. Upon doing so, the method proceeds to repeat steps 1002 to 1020.
[0154] Interpretation.
[0155] Aspects of the present invention may be described with reference to flowchart illustrations and/or block diagrams of methods, apparatus (systems) and computer program products according to embodiments of the invention. It will be understood that each block of the flowchart illustrations and/or block diagrams, and combinations of blocks in the flowchart illustrations and/or block diagrams, can be implemented by computer program instructions. These computer program instructions may be provided to a processor of a general purpose computer, special purpose computer, or other programmable data processing apparatus to produce a machine, such that the instructions, which execute via the processor of the computer or other programmable data processing apparatus, create means for implementing the functions/acts specified in the flowchart and/or block diagram block or blocks.
[0156] The flowchart and block diagrams in the Figures illustrate the architecture, functionality, and operation of possible implementations of systems, methods and computer program products according to various embodiments of the present invention. In this regard, each block in the flowchart or block diagrams may represent a module, segment, or portion of code, which comprises one or more executable instructions for implementing the specified logical function(s). It should also be noted that, in some alternative implementations, the functions noted in the block may occur out of the order noted in the figures. For example, two blocks shown in succession may, in fact, be executed substantially concurrently, or the blocks may sometimes be executed in the reverse order, depending upon the functionality involved. It will also be noted that each block of the block diagrams and/or flowchart illustration, and combinations of blocks in the block diagrams and/or flowchart illustration, can be implemented by special purpose hardware-based systems that perform the specified functions or acts, or combinations of special purpose hardware and computer instructions.
[0157] The corresponding structures, materials, acts, and equivalents of all means or steps plus function elements in the claims appended to this specification are intended to include any structure, material, or act for performing the function in combination with other claimed elements as specifically claimed.
[0158] References in the specification to “one embodiment”, “an embodiment”, etc., indicate that the embodiment described may include a particular aspect, feature, structure, or characteristic, but not every embodiment necessarily includes that aspect, feature, structure, or characteristic. Moreover, such phrases may, but do not necessarily, refer to the same embodiment referred to in other portions of the specification. Further, when a particular aspect, feature, structure, or characteristic is described in connection with an embodiment, it is within the knowledge of one skilled in the art to affect or connect such module, aspect, feature, structure, or characteristic with other embodiments, whether or not explicitly described. In other words, any module, element or feature may be combined with any other element or feature in different embodiments, unless there is an obvious or inherent incompatibility, or it is specifically excluded.
[0159] It is further noted that the claims may be drafted to exclude any optional element. As such, this statement is intended to serve as antecedent basis for the use of exclusive terminology, such as “solely,” “only,” and the like, in connection with the recitation of claim elements or use of a “negative” limitation. The terms “preferably,” “preferred,” “prefer,” “optionally,” “may,” and similar terms are used to indicate that an item, condition or step being referred to is an optional (not required) feature of the invention.
[0160] The singular forms “a,” “an,” and “the” include the plural reference unless the context clearly dictates otherwise. The term “and/or” means any one of the items, any combination of the items, or all of the items with which this term is associated. The phrase “one or more” is readily understood by one of skill in the art, particularly when read in context of its usage.
[0161] The term “about” can refer to a variation of ±5%, ±10%, ±20%, or ±25% of the value specified. For example, “about 50” percent can in some embodiments carry a variation from 45 to 55 percent. For integer ranges, the term “about” can include one or two integers greater than and/or less than a recited integer at each end of the range. Unless indicated otherwise herein, the term “about” is intended to include values and ranges proximate to the recited range that are equivalent in terms of the functionality of the composition, or the embodiment.
[0162] As will be understood by one skilled in the art, for any and all purposes, particularly in terms of providing a written description, all ranges recited herein also encompass any and all possible sub-ranges and combinations of sub-ranges thereof, as well as the individual values making up the range, particularly integer values. A recited range includes each specific value, integer, decimal, or identity within the range. Any listed range can be easily recognized as sufficiently describing and enabling the same range being broken down into at least equal halves, thirds, quarters, fifths, or tenths. As a non-limiting example, each range discussed herein can be readily broken down into a lower third, middle third and upper third, etc.
[0163] As will also be understood by one skilled in the art, all language such as “up to”, “at least”, “greater than”, “less than”, “more than”, “or more”, and the like, include the number recited and such terms refer to ranges that can be subsequently broken down into sub-ranges as discussed above. In the same manner, all ratios recited herein also include all sub-ratios falling within the broader ratio.